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ABSTRACT 

A time-controlled navigation system applicable to the descent 
phase of flight for airline transport aircraft has been 
developed and simulated. The design contained herein incor- 
porates the linear discrete-time sampled-data version of the 
linearized continuous-time system describing the aircraft’s 
aerodynamics. Using optimal linear quadratic control tech- 
niques, an optimal deterministic control regulator which is 
implementable on an airborne computer is designed. The 
navigation controller assists the pilot in complying with 
assigned times of arrival along a four-dimensional flight path 
in the presence of wind disturbances. 

In this study, the strategic air traffic control concept is 
also described, followed by the design of a strategic control 
descent path. A strategy for determining possible times of 
arrival at specified waypoints along the descent path and for 
generating the corresponding route-time profiles that are with- 
in the performance capabilities of the aircraft is presented. 

Using a mathematical model of the Boeing 707-320B aircraft 
along with a Boeing 707 cockpit simulator interfaced with an 
Adage AGT-30 digital computer, a real-time simulation of the 
complete aircraft aerodynamics was achieved. The strategic 
four-dimensional navigation controller for longitudinal dynamics 
was tested on the nonlinear aircraft model in the presence of 
15, 30, and 45 knot head-winds. The results reported herein 
indicate that the controller preserved the desired accuracy and 
precision of a time-controlled aircraft navigation system. 
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CHAPTER I 
INTRODUCTION 

The Federal Aviation Administration (FAA) is responsible 
for the control of air traffic within the United States. The 
FAA's objective is to provide a continued growth in air traffic 
control services by utilizing improved technology to satisfy 
the ever-increasing demand for safe, orderly and expeditious 
flow of aircraft within the airways system [1,2]. Four-dimen- 
sional (4-D) aircraft navigation is one concept proposed to 
solve this problem. Navigation incorporating the fourth 
dimension of time is categorized as a strategic air traffic 
control concept [3], Time-controlled navigation is a concept 
whereby available airspace and airports are utilized more 
efficiently to achieve increased airport capacity. 


1.1 STRATEGIC AIR TRAFFIC CONTROL 
Strategic air traffic control is an organizational plan 
wherein the factors of space management, energy management and 
time management are integrated co determine a four-dimensional 
route-time profile to be assigned to each aircraft. Strategic 
control is a specific method whereby the air traffic control 
(ATC) system defines flight paths in four-dimensions (cross- 
track, along-track, altitude, and time) to resolve traffic 
conflicts [3], 




13 


Time control can be broadly defined as a guidance system 
which places an aircraft at a specified three-dimensional (3-D) 
geographical location at an assigned time. Three methods have 
been proposed to implement this type of control. The first 
method utilizes the ground-based air traffic control system to 
transmit a sequence of radar vectors to each aircraft. This 
is similar to present ATC procedures in which aircraft arrive 
randomly at the boundaries of the terminal area and are aligned 
in a string prior to landing by a series of controller-generated 
heading and speed commands. This method, primarily employing 
"path stretching" maneuvers, neither employs optimum energy 
management procedures, nor provides sufficient accuracy in the 
fourth dimension of time. 

The second method of control could be achieved if pilots 
utilized an airborne guidance system to follow a predetermined 
assigned 3-D route while receiving speed commands from the 
ground-based air traffic controller. With this method, control 
is shared jointly by the airborne system and the ground-based 
system. 

In the first two types of time control, a significant 
amount of cor. :roller-pilot communication is required. A third 
type of control, which reduces the communication workload re- 
quirement, could be entirely executed by the airborne system 
using precision four-dimensional navigation/guidance equipment 
[3] which requires the pilot to fly an assigned route-time 
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profile. The airborne system would be responsible for 
generating descent {or ascent) and speed commands which would 
ensure arrival at three-dimensional geographic locations at 
pre-assigned times. 

The Federal Aviation Administration currently favors a 
totally centralized aircraft management system similar to the 
first type of time control. This concept utilizes a ground- 
based system to generate a 4-D schedule, to transmit a sequence 
of commands to each aircraft, and to monitor, detect and 
correct any deviations from the schedule. Those favoring 
"distributed management," employing the third type of time 
control, believe that the pilot should participate more actively 
in the air traffic control process [6]. This study is oriented 
toward the latter type of time control, whereby the pilot 
would utilize an airborne system to detect and correct for any 
deviations from the 4-D schedule. 

In a strategic air traffic control system, aircraft would 
request entry into the system from the ground-based controller. 
The ground-based system would consider other traffic and 
measured or estimated values of winds aloft and temperature in 
generating a four-dimensional, conflict-free, route-time pro- 
file based on the aircraft's groundspeed performance envelope. 
The ground facility would then transmit this route-time profile 
to the aircraft. The aircraft 's avionics and on*board navigation 
systems would be designed to achieve precise four-dimensional 
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control in the presence of actual environmental conditions 
encountered in flight such as unexpected winds. 

The overall strategic control structure from entry into 
the system to execution of the assigned route-time profile is 
depicted in block diagram form in Figure 1-1. It is the 
execution of the route-time profile and adherence to the 4-D 
schedule that are the major concerns of this study. 

1.1.1 RESEARCH OBJECTIVES AND DESIGN GOALS 

The main objective in this research effort is to inves- 
tigate the engineering feasibility of four-dimensional naviga- 
tion using an optimal feedback controller which could be 
implemented by the airborne computer system. The development 
of a time-controlled navigation system is motivated by three 
general goals : to improve air traffic control performance 

and increase safety, to utilize available airspace more 
efficiently and increase airport capacity, and to reduce 
operating costs. 

As strategic control is primarily designed for automatic 
operation [3], it is necessary to understand aircraft perfor- 
mance capabilities, the effects of wind and temperature, and 
the on-board computer requirements. With a comprehensive 
understanding of these issues, this study is directed toward 
the fundamental problem facing controllers and pilots--the 
problem of safe and efficient guidance and control of aircraft 
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within the air traffic control environment [17]. From this 
consideration evolves the two specific goals of this study: 

1) determination of route-time profiles, and 2) design and 
evaluation of a four-dimensional navigation/guidance system 
controller that executes the route-time profile using real-time 
simulation capabilities. 

1.2 ASSIGNMENT OF FLIGHT PATHS AND ARRIVAL TIMES 

The precise control of aircraft using a 4-D concept is 
certainly a practical possibility for the air traffic control 
system of the 1980's and beyond. The ground-based air traffic 
computer would generate four-dimensional flight paths for all 
strategically controlled aircraft. The layout of these 
strategic flight paths must consider airspace geometry, en- 
vironmental effects, and aircraft performance capabilities. It 
is desirable to define these flight paths in terms of horizontal 
position, altitude, and time such that they make the most 
efficient use of the available airspace. The routes and times 
assigned must be within the performance capabilities of each 
aircraft and must be assigned so as not to conflict with the 
routes and times of other aircraft. The Boeing Company has con- 
sidered these aspects in detail in their study on strategic 
air traffic control [3,4,5]. 

The assignment of arrival times is constrained by aircraft 
performance, and thus, there is a finite range of arrival 
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times which each aircraft can achieve for a fixed 3-D route 
profile without holding. This range is lower bounded by the 
earliest possible time of arrival (EPTA) and upper bounded by 
the latest possible time of arrival (LPTA) . The earliest 
possible time of arrival is that time at which the aircraft 
would arrive if it accelerated to its maximum airspeed, flew 
at that maximum, and then decelerated to comply with any air- 
speed constraints at the assigned waypoint (essentially a 
minimum time "bang-bang" control law) . Likewise, the latest 
possible time of arrival is that time the aircraft would arrive 
if it decelerated to its minimum airspeed, flew at that minimum, 
and then accelerated to comply with airspeed constraints at the 
assigned waypoint. The complete set of possible arrival times 
can be computed by utilizing the entire aircraft performance 
envelope. Once an assignment of arrival time is made, it is 
desirable to determine a corresponding route-time profile that 
will guarantee aircraft arrival at designated waypoints at the 
assigned times. The route-time profiles are generated in 
terms of groundspeeds which are piecewise linear approximations 
to constant Mach and/or indicated airspeeds that have been 
corrected for wind and temperature [5]. These groundspeeds 
integrated over the descent route distances correspond to a 
particular time of arrival that may be assigned to the air- 
craft. Time-controlled navigation can be applied to the entire 
flight, from take-off to landing, but presently the greatest 
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need for this capability is within the descent phase of 
flight. The descent phase of flight, as referred to in this 
study, is defined to be that segment of flight where transi- 
tion occurs between enroute altitudes and the outer boundary of 
the airport terminal area (at approximately 30-35 nautical 
miles from the airport at an altitude of 10,000 feet). It is 
within this phase of flight, between cruise altitudes and entry 
into the terminal area, where derandomization of aircraft in 
time can be achieved most efficiently to ensure proper 
separation between aircraft. Utilizing time-controlled navi- 
gation during the descent phase of flight would eliminate most 
delays now imposed inside into the terminal area. 

In Chapter II, a strategic control descent route profile 
will be described in detail. In addition, a strategy for 
determining the possible times of arrival at specified way- 
points along the descent path and for generating the corres- 
ponding route-time profiles for each type of aircraft will be 
presented. 


1.3 THE 4-D STRATEGIC NAVIGATION CONTROLLER 
The relationship between aircraft performance and the 
route-time profiles which are achievable is essential to the 
airborne navigation concept. A precise and accurate mathe- 
matical model of the Boeing 707-320B aircraft has been 
developed by Charles Corley in his study on aircraft time- 
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controlled navigation [6]. 

With the use of this aircraft model and the associated 
atmosphere model, a 4-D strategic navigation control regulator 
has been designed, simulated and evaluated. In the presence 
of winds, pilot error and inaccuracies in observing position 
and speed, an optimal solution for flight path regulation is 
desirable in order to best preserve the time precision in- 
herent in 4-D navigation. The ultimate objective of the 
design is to obtain an optimal linear discrete-time feedback 
solution that will achieve the accuracy required for effective 
time-controlled navigation. 

The design procedure requires linearization of the non- 
linear aircraft equations of motion to obtain a linear con- 
tinuous-time system. The linearization is performed about 
nominal trajectories which are acquired by "flying” the desired 
route-time profile using the complete nonlinear aircraft 
model in a real-time simulation. When considering the actual 
physical implementation of the 4-D navigation controller, it 
is desirable to implement the discrete-time equivalent to the 
continuous-time linear system. The discrete-time system was 
formulated as the sampled-data version of the continuous-time 
system. Using linear quadratic control techniques, a cost 
function was formulated and the discrete-time linear feedback 
solution was derived. In the derivation, the wind components 
of the system were formulated as exogenous variables. These 
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wind components were treated as known deterministic distur- 
bances for purposes of this study. 

The novelty of this approach leads to a feedback solution 
that consists of two parts. One part is dependent upon any 
deviations in the states of the system while the second part 
is an exogenous component dependent upon wind disturbances. 

Both the feedback gains and exogenous components are time- 
varying. When the wind is formulated as an exogenous variable 
to the system, the choice of the weighting matrices in the cost 
function becomes extremely important. The difficulty in 
choosing these weighting matrices arises from the fact that the 
performance of the feedback solution must be evaluated for each 
choice in a real-time simulation wherein the optimal discrete- 
time linear feedback law is implemented on the complete non- 
linear aircraft model. 

The ability to evaluate the controller design during the 
real-time simulation was greatly facilitated by actual obser- 
vation of the system responses as displayed on the aircraft's 
instruments in the cockpit simulator. The simulation 
facilities will be described in more detail in the following 
section. 

The design of the 4-D navigation controller as discussed 
in this section will be presented in greater detail in Chapter 
IV. The formulation of the discrete-time linear system and 
the derivation of the appropriate optimal feedback law will be 
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thoroughly presented. The nominal state and control tra- 
jectories along with the performance weighting matrices will 
be presented in Chapter V. In addition, and most importantly, 
an evaluation of the 4-D navigation controller, based on its 
performance in real-time simulations when implemented on the 
complete nonlinear aircraft model, will be discussed in 
Chapter V. Finally, the accomplishments of this study, 
recommendations for further research, and the overall con- 
clusion will be presented in Chapter VI. 

1.4 T HE AIRCRAFT SIMULATION 

The simulation facilities of the Electronics Systems 
Laboratory, the Flight Transportation Laboratory, and the 
Man-Vehicle Laboratory at M.I.T. consists of a fixed-base 
cockpit simulator resembling a Boeing 707 aircraft. The. cock- 
pit simulator, with interior panels, switches, controls, and 
instrumentation facsimilies, was donated to M.I.T. by the 
Boeing Company. The cockpit simulator has been used exten- 
sively to study new technology applicable to future air traffic 
control systems. An interior view of the cockpit simulator is 
shown in Figure 1-2. 

An Adage AGT-30 digital computer is interfaced with the 
cockpit simulator. The computer simulates the aircraft's 
aerodynamics and drives the simulator's flight instruments 
using three cathode ray tubes. The basic flight instruments 
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as shown in Figure 1-3 are simulated for the Captain and First 
Officer and the Airborne Traffic Situation Display [8] is also 
presented in the cockpit. A block diagram depicting the 
interface between the cockpit simulator. Adage computer, and 
associated peripheral equipment is shown in Figure 1-4. 
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CHAPTER II 

the strategic air traffic control environment 

A strategic air traffic control system has two basic 
components. The first component is the descent flight path 
which the aircraft is assigned to fly. The second component 
is the assignment of a velocity schedule to be executed along 
the descent flight path. These two components combine to 
determine a route-time profile which dictates the rate at 
which the flight path is to be traversed. Since there is a 
range of airspeeds that can be maintained along a given flight 
path, it is difficult for the pilot to decide what airspeed 
schedule will ensure arrival at certain waypoints at specified 
times. Thus, it is desirable for the pilot to have a pre- 
determined route-time profile which will ensure arrival at 
waypoints at times specified by the ground-based air traffic 
controller. 

The Boeing Company and the National Aeronautics and Space 
Administration have studied these issues pertaining to 4-D 
navigation and have proposed several methods of solution [3,4, 
5,17], In this chapter, a flight path applicable to the 
descent phase of flight is defined. A procedure for calculating 
possible times of arrival at various waypoints is also 
described along with a strategy for generating route-time 
profiles . 
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2.1 STRATEGIC CONTROL DESCENT PROFILE 

The Boeing study points out that "airplane performance 
is probably the single most important criterion in the design 
of the terminal area descent profile." [4:p.63] The aero- 
dynamic capabilities of the aircraft limit the flexibility 
available in the design of the descent track profile. For 
each type of aircraft, the available drag, lift, thrust, and 
gross weight combine to constrain and limit the flight path 
angle (slope of descent path) at which the aircraft can 
descent without accelerating due to gravity. For time-con- 
trolled navigation, it is desirable to design a descent pro- 
file with a flight path angle that preserves sufficient air- 
craft acceleration and deceleration capability in order to 
achieve the required time accuracy. 

The Boeing study has suggested that fixed linear descent 
profiles be used. Such linear profiles are desirable from a 
scheduling point of view and provide well defined airspace 
structures that simplify conflict-free flight path design. 

The strategic control descent and arrival path used in this 
study is a modified version of one suggested by Boeing and is 
depicted as a function of altitude and distance in Figure 2-1. 

When the aircraft is maintaining a constant flight path 
angle without accelerating or decelerating, the descent 
gradient (y^) is equal to the descent track slope (y t ) [4] and 
is expressed by the following relationships: 


PRESSURE ALTITUDE (1000 FEET) 



2-1 


y^ = descent gradient = 


drag _ thrust 
lift weight 


1 


t 


= descent track slope =* 


vertical distance 
horizontal distance 


2-2 


If the aircraft is in accelerated or decelerated flight along 
a fixed descent track, the descent gradient required for the 
aircraft is expressed as: 

Yj = descent gradient required = y. (1 + — 3 tr ) 2-3 

d req t g dh 

This required descent gradient must be within the performance 
capabilities of the aircraft if it is required to fly a con- 
stant descent path while descending at speeds other than 
constant true airspeed (TAS) , such as constant Mach number or 
constant indicated airspeed (IAS) , which require acceleration 
or deceleration, In a clean configuration (landing gear up 
and flaps retracted) , the only method for increasing or de- 
creasing gradient is by varying engine thrust. Additional 
gradient can be achieved by deploying aircraft spoilers when 
engines are at idle thrust. 

The rate of vertical descent (dh/dt) required to maintain 
a constant flight path angle is a function of speed and is 
limited by cabin repressurization rate, anti-icing power re- 
quirements, and the effects of wind and temperature on the 
performance capabilities [3,5,17]. 
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Choice of a vertical descent gradient must be within the 
performance capability of all aircraft utilizing fixed linear 
strategic control descent profiles. Boeing suggests a slope 
of 250 feet per nautical mile above 10,000 feet and 300 feet 
per nautical mile below that altitude, while others [7,18] 
have recommended slopes of 300 feet per nautical mile at all 
altitudes. The descent track slope chosen for use in this 
study is approximately 3° corresponding to a vertical descent 
gradient of 318 feet per nautical mile. 

The descent route profile as shown in Figure 2-1 includes 
a level flight deceleration segment at 10,000 feet to provide 
for the transition from high descent speeds to a speed not 
exceeding 250 knots indicated, as required by the FAA for 
flight below 10,000 feet. The length of this deceleration 
segment has been chosen to be 15 nautical miles. This is 
sufficient to accommodate a level deceleration at idle thrust 
from the maximum operating true airspeed at 10,000 feet to 
200 knots indicated airspeed with a 72 knot tailwind. It is 
reasonable to assume that this deceleration segment is ade- 
quate for most flight situations. 

The complete strategic control descent profile as de- 
picted in Figure 2-1 is described geographically by the 

* This calculation is based on actual flight measurements 
made by Captain Carl W. Vietor of American Airlines. 



32 


position of each waypoint along its linear path segments. 

This three-dimensional route is described by the following 
points : 

1. ENTRY FIX. This point, approximately 150 to 175 
nautical miles from the airport is fixed and de- 
fines the point at which the aircraft enters the 
strategic control system. Known entry fixes allow 
schedules and times to be determined over known 
distances. 

2. INITIAL APPROACH FIX. Entry into the terminal area 
would occur at this point approximately 30 to 35 
nautical miles from the airport. The desired spacing 
of aircraft is achieved by speed control between 

the entry fix and the initial approach fix with 
possible parallel paths to resolve conflicts. 

3. TURN FIX. At this point, inside the initial approach 
fix, aircraft from several entry fixes would merge 
and be positioned on a common path within the 
terminal area. 

4. OUTER MARKER. From the turn fix to the outer marker, 
all aircraft adhere to the same velocity profile 
along a common path. 

5. RUNWAY THRESHOLD. Once inside the outer marker, 
each aircraft is flown at its appropriate final 
approach speed down to the runway threshold. 

6. WAYPOINTS. These are additional points as required 
for any turns or descents or to insure time separa- 
tion between aircraft along a common path. 

With the additional assignment of arrival times at various 

points along the descent path, a velocity -route -time profile 

can be determined. 


2.2 ROUTE -TIME PROFILE GENERATION 


Strategic control is a concept which may be applied to 
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the entire flight, from departure to landing. However, this 
study is principally concerned with the descent phase of 
flight between the entry fix and the initial approach fix. It 
is assumed that all aircraft can fly a common path and air- 
speed profile from the initial approach fix to the outer 
marker. Therefore, it is within the descent phase of flight 
from cruise altitudes into the terminal area where the greatest 
need for the strategic control concept can be foreseen. It is 
within this phase of flight where the greatest amount of time 
control can be achieved, thus where derandomization of aircraft 
in time (sequencing and scheduling) must be accomplished in 
order to ensure proper merging of aircraft inside the initial 
approach fix and suitable separation of aircraft at the outer 
marker . 


2.2.1 ASSIGNMENT OF ARRIVAL TIMES 
The assignment of the desired time of arrival at the IAF 
and any intermediate waypoints is the responsibility of the 
ground-based strategic air traffic controller. The control 
algorithm must assign a time of arrival at the IAF that is 
within the earliest possible time of arrival (EPTA) and the 
latest possible time of arrival (LPTA) which are constrained 
by the groundspeed performance envelope along the descent 
route profile. The EPTA is based on the maximum groundspeeds 
that the aircraft can achieve along the descent path. These 



speeds vary with altitude and are constrained by structural 
limitations, by maximum available thrust, by environmental 
conditions, or below 10,000 feet, by FAA directives. The LPTA 
is based on the minimum groundspeeds that the aircraft can 
achieve. These speeds are also a function of altitude and 
environmental effects, and are related to the airspeed at 
which the aircraft can perform a 1.3g maneuver without 
buffeting [4] . The difference between the LPTA and the EPTA 
is known as the delay spread and the relative position of the 
assigned time of arrival (ATA) within the delay spread is 
referred to as the time flexibility available [6] . Maximum 
time flexibility is achieved when LPTA- ATA = ATA-EPTA, thus 
the aircraft is capable of arriving earlier or later than the 
assigned time by the same amount [61. This is certainly 
desirable in the event that the strategic controller would 
have to reschedule aircraft due to emergency or weather con- 
ditions . 

Given fixed descent route profiles, desired times of 
arrival at various waypoints can be assigned to aircraft upon 
reaching the entry fixes. Whereas the aircraft's performance 
capabilities affect and limit the actual descent route profile, 
the aircraft’s groundspeed envelope affects the range of 
achievable arrival times at selected waypoints. 

The ground-based strategic controller would have know- 
ledge of the groundspeed performance envelope for each type 
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of aircraft. The scheduling and conflict detection algorithms, 
with knowledge of the descent route profile, would sequence 
the aircraft and assign non-conflicting times of arrival [5] 
at the initial approach fix as well as any additional times of 
arrival at specified waypoints along the descent path. (See 
Figure 1-1 for the general structure of this procedure.) 

Since the groundspeed performance envelope is ultimately 
used to compute the range of arrival times at the IAF and the 
corresponding route-time profiles, it is important to consider 
its formulation . 


2.2.2 GROUNDSPEED PERFORMANCE ENVELOPE 
True airspeed is the speed with which the airplane moves 
through the airmass. Groundspeed is the vector sum of the 
true airspeed and the wind. Thus knowledge of the wind vec- 
tor along the geographical path is necessary to determine the 
groundspeed velocity profile that is within the aeroperfor- 
mance capabilities of the aircraft along the pre-de fined route . 

True airspeed performance curves are commonly based on 
Standard day conditions. Pressure altitude, the altitude 
measured with an altimeter set at 29.92 inches of mercury, is 
equal to the height above sea level for standard day tem- 
peratures (15°C at sea level). For non-standard day tem- 
peratures, there is a deviation between pressure altitude and 
the actual height above sea level. Therefore, an adjustment 
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in the aircraft's performance curves, which are based on 
pressure altitude, is necessary. This adjustment alters the 
true airspeed velocity profile and thus the groundspeed 
velocity profile* 

A typical standard day aeroperformance velocity profile 
is shown in Figure 2-2. The general procedure, as suggested 
in the Boeing study [5], for modifying the standard day aero- 
performance envelope to obtain an aeroperformance temperature 
and wind corrected groundspeed envelope is depicted in 
Figures 2-3 and 2-4. A complete typical transformation of 
the standard day operating envelope to obtain the corres- 
ponding groundspeed envelope is shown in Figure 2-5. 

2.2.3 ROUTE-TIME PROFILE STRATEGY 

The strategy used for generating the route-time profile 
is one suggested by the Boeing company [5] and modified in 
this study. The aircraft enters the strategic control system 
in level flight at the entry fix. The aircraft then acceler- 
ates or decelerates in level flight to its initial descent 
velocity (IDV) . Upon intercepting the descent path, the air- 
craft will fly a velocity-altitude profile while descending. 
This velocity-altitude profile, referred to as a Mach/IAS 
profile [5], implies a particular Mach number and IAS, each 
corresponding to a specific airspeed to be maintained while 
descending through certain altitudes along the descent path. 





Fig. 2-2 Typical Standard Day Velocity Profile 




Fig, 2-3 Aircraft Operating Envelope Corrections 
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Fig. 2-4 General Construction of Groundspeed Operating Envelope 



PRESSURE ALTITUDE (1000 FEET) 



SPEED/TEMPERATURE (KNCTS/°C) 

Fig. 2-5 Typical Gioundspeed Operating Envelope 


The aircraft reaches the initial approach fix altitude at the 
final descent velocity (FDV) . At this altitude, another 
acceleration or deceleration in level flight is performed to 
the desired final velocity at the IAF. The initial and final 
descent speeds are groundspeeds but are converted to Mach 
number or IAS for use in the route-time profile. 

Associated with every possible arrival time at the IAF is 
a route-time profile consisting of a set of velocity-position- 
time points that satisfy the boundary conditions at the entry 
fix and the initial approach fix [5] . The velocities specified 
in the route-time profile are indicated airspeeds or Mach num- 
bers which are those airspeeds that are indicated in the cock- 
pit and by which the pilot is accustomed to flying. Since the 
route-time profile is derived using the aircraft's operating 
envelope, the groundspeeds which must be flown along the 
descent path must be converted to Mach number or indicated air- 
speed using altitude and environmental information. The 
vertical speeds required to maintain the fixed descent path is 
a simple calculation given the groundspeed curve associated 
with a particular ATA. 

The route-time profile generation strategy is character- 
ized by two basic aspects: 1) the determination of the IDV, 

the corresponding FDV, and the Mach/IAS profile used in tran- 
sitioning between these velocities during letdown, and 2) the 
procedure for acceleration or deceleration in the level flight 
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segments at the entry fix and initial approach fix altitudes. 

In order to describe the Mach/IAS letdown strategy, it 
is convenient to create certain waypoints along the descent 
path. These intermediate waypoints between the EF and the IAF 
as shown in Figure 2-1 are described as follows: 

1. WAYPOINT #1 (WP1) . At the point where the initial 
descent from the EF altitude begins. 

2 . WAYPOINT #2 (WP2) . At the point where the descent 
path passes through the critical (transition) 
altitude. 

3. WAYPOINT #3 (WP3) . At the point where the descent 
path intersects the IAF altitude . 

As previously described, the groundspeed operating 
envelope is defined by the gross weight of the aircraft, fore- 
casted winds, and temperatures along the known strategic con- 
trol descent profile. In this study, the temperatures are 
assumed to be standard day temperatures and the forecasted 
winds are considered variable. The procedure for generating 
Mach/IAS profiles can best be explained at this point by means 
of actual examples. 

Consider the velocity profile in Figure 2-6 for the 
Boeing 707-32 OB aircraft used in this study. The heavy lines 
indicate a velocity profile for an aircraft gross weight of 
225,000 pounds. These lines limit the range of permissible 
velocities and provide a buffer region for pilot error. It can 
be seen that the maximum operating velocity is achievable at 
the critical altitude. The high speed boundary of the velocity 
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STANDARD DAY 
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Fig. 2-6 Velocity Profile - Boeing 707-320B 
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envelope above the critical altitude is constrained by thrust 
and is closely approximated by a constant Mach number. The 
high speed boundary below the critical altitude is constrained 
by the maximum operating velocity and is closely related to a 
constant equivalent airspeed (EAS) . The low speed boundary of 
the aircraft velocity envelope, which is defined by the air- 
speed at which the aircraft can perform a l„3g maneuver without 
buffeting, is also approximated by a constant EAS. EAS is 
related to calibrated airspeed (CAS) by a compressibility 
factor and CAS is related to IAS by the instrument and position 
errors in the actual airspeed indicator of the aircraft [15] . 
For purposes of this study and in the real-time simulation of 
the aircraft, indicated airspeeds are equal to calibrated air- 
speeds and the compressibility factor can be neglected so that 
the EAS boundaries of the performance envelope can be approxi- 
mated by indicated airspeeds. 

For a particular initial descent velocity, the route-time 
profile generation strategy determines a constant Mach number 
for letdown between the entry fix altitude (at WP1) and the 
transition altitude (at WP2),and a constant IAS for letdown be- 
tween the transition altitude and the initial approach fix 
altitude (at WP3) . Thus, the transition altitude is defined as 
that altitude where transition from a constant Mach airspeed 
schedule to a constant IAS schedule occurs. For any initial 
descent velocity within the boundary speeds at the entry fix 
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altitude, the transition altitude is the same as the critical 
altitude as defined by the aircraft's velocity envelope. When 
the initial descent velocity is equal the minimum allowable 
velocity at the entry fix altitude, the transition altitude 
can be varied between the critical altitude and the entry fix 
altitude in order to utilize the entire aeroperformance 
envelope. Several Mach/IAS letdown profiles are indicated in 
Figure 2-6. 

The Mach/IAS letdown strategy ensures that the resulting 
rate of change of velocity with respect to altitude (dV/dh) is 
within the gradient capability of the aircraft [5] . In 
addition the entire aeroperformance envelope is utilized, thus 
maximizing the resulting time controllability over the range 
of possible times of arrival. Although the gradient capability 
of the aircraft is not exceeded using this strategy, the 
reserve gradient capability, which is a function of the 
descent track slope as well as the aircraft performance capa- 
bilities, is not optimized. Thus the aircraft has less po- 
tential control to adapt to environmental disturbances. At 
the expense of reducing total time controllability, the re- 
serve gradient capability could be optimized using a letdown 
strategy based on constant IAS or by using variable slope 
descent tracks. Such alternative strategies will not be con- 


sidered here. 


The second important aspect of the route-time profile 
generation strategy is the method of acceleration or decelera- 
tion between the boundary speed velocities at the entry fix 
and initial approach fix, and the initial and final descent 
velocities respectively. For any possible IDV, the tran- 
sition between the initial velocity at the entry fix and the 
IDV is linear with respect to time during the period of level 
flight at the entry fix altitude. This results in a constant 
acceleration or deceleration along the entire level flight 
segment. Likewise, the transition between the FDV and the 
required final velocity at the IAF is also assumed to be 
linear with respect to time. Similarly, this results in a 
constant acceleration or deceleration rate over the 15 nauti- 
cal mile level flight segment at the initial approach fix 
altitude . 

For the case when the initial descent velocity is at its 
maximum allowable value, the fastest Mach/IAS profile is flown 
during letdown. Additional time controllability can be 
achieved in order to arrive earlier by first varying the rate 
of acceleration from the initial EF velocity to the IDV and 
then flying at the IDV for the remaining level flight segment 
until the descent path is intercepted. The maximum accelera- 
tion rate achievable by the aircraft at the EF altitude limits 
the amount of additional time controllability attainable at 
that altitude. Then additional time controllability can be 



47 


achieved at the IAP altitude by flying level at the FDV and 
varying the deceleration to the desired final velocity at the 
IAF. Again, the additional time controllability attainable 
at this altitude is limited by the aircraft's maximum decelera- 
tion rate. In a similar manner, for the case when the slowest 
Mach/IAS profile is flown during letdown, additional time 
controllability can be achieved in order to arrive later by 
varying the deceleration rate at the EF altitude and the 
acceleration rate at the IAF altitude. The scheduler could 
also assign a final velocity at the IAF that is less than 
250 KIAS in order for the aircraft to be able to arrive even 
later. 

Therefore, the complete route-time profile can be 
generated using the strategic control strategy described in 
this section. Summarizing, the aircraft adheres to a specific 
linear altitude-ground track descent profile, thus any initial 
descent velocity implies a particular Mach/IAS for letdown. 

The choice of the initial descent velocity is the primary 
variable in determining a route-time profile that satisfies 
the boundary conditions at the entry fix and initial approach 
fix. In addition, when the initial descent velocity is at its 
minimum value, the choice of the transition altitude between 
the critical altitude and the entry fix altitude is an 
additional variable in determining the route-time profile. For 
different Mach/IAS letdown profiles, an integration of the 
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corresponding wind and temperature corrected groundspeed pro- 
files over the fixed descent route results in a range of 
achievable arrival times at the IAF for the given boundary 
conditions . 

2.2.4 ROUTE-TIME PROFILE BOUNDARY CONDITIONS USED IN THIS STUDY 
In this study, the strategic control descent profile 
between the entry fix and initial approach fix, with dimensions 
exactly as depicted in Figure 2-1, is applied to the descent 
phase of flight for airline transports from cruise altitudes 
down the boundary of the Terminal Control Area of Logan Inter- 
national Airport. The descent route profile lies in a single 
vertical plane at an orientation of 53.07° from magnetic 
north. The aircraft enters the strategic control system at 
a cruise altitude of 35,000 feet with a true airspeed of 476 
knots at the entry fix which is located approximately 155.4 
natuical miles from the airport and 125.4 nautical miles from 
the Providence VOR (very high frequency omni-range) station 
along its 233.07° radial. The IAF is located directly over the 
Providence VOR at an altitude of 10,000 feet. Imposing the 
constraint of an assigned time of arrival at the IAF, the air- 
craft must reach this waypoint with a final indicated airspeed 
not exceeding 250 KIAS by controlling its airspeed along the 
route profile. 
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The aircraft’s initial position at the entry fix, its 
terminal position at the initial approach fix, and the air- 
craft's ground track in transversing from the EF to the IAF 
are illustrated in Figure 2-7 with respect to an arbitrarily 
chosen earth coordinate system. The earth coordinate system 
has its origin located approximately at 71° 11' W, 42° 12' N, 
corresponding to a point 1,050 feet past the threshold of 
runway 4R (approximately at the aircraft touchdown point) at 
Logan International Airport, Boston, Massachusetts. The posi- 
tive earth X-axis is coincident with runway 4R at a magnetic 
heading of 35°. The positive Y-axis is at a magnetic heading 
of 125°. The positive Z-axis is perpendicular to the earth's 
surface and points upward; this axis measures altitude (h) . 


2.3 CALCULATION OF ARRIVAL TIMES AND ROUTE-TIME PROFILES 
Applying the route-time generation strategy described 
previously to the descent profile depicted in Figure 2-1 
along with the aircraft’s boundary conditions and specific 
ground track shown in Figure 2-7, the possible times of arrival 
at the IAF corresponding to various initial descent velocities 
and transition altitudes are presented in Table 2-1 for the 
Boeing 707-320B aircraft. These times are based on standard 
day conditions without wind as described by the aircraft’s 
velocity profile in Figure 2-6. For each initial descent velo- 
city and transition altitude, the times of arrival at the 



Fig. 2-7 Earth Coordinate System Map and Aircraft Ground Track 
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specified waypoints along the descent profile are based on: 

1) linear groundspeed transitions with respect to time at 
the entry fix and initial approach fix altitudes, and 2) ground- 
speeds which are piecewise linear approximations to the 
constant Mach/IAS profile during letdown between the EF and 
IAF altitudes, where the groundspeeds reflect approximate wind 
and temperature corrections [5] . 

The particular route-time profile used in this study 
corresponding to an ATA of 19,73 minutes at the IAF is shown 
in Table 2-2. 

The actual equations used in calculating the possible 
times of arrival at the IAF and the corresponding route-time 
profiles are included in the computer programs "ATA" and " RTP ” 
which are listed in Appendix B. 
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TABLE 2-2 


ROUTE-TIME PROFILE — ATA = 19.73 MINUTES 
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CHAPTER III 
THE AIRCRAFT MODEL 

Airspeed flexibility is a fundamental requirement for all 
aircraft operating in a strategic air traffic control environ- 
ment utilizing a time-controlled navigation system. The 
similarity in operating airspeeds and cruising altitudes for 
modern jet transport aircraft is apparent from the aeroper- 
formance data contained in Table 3-1. The conclusion to be 
drawn from this data is that typical modern jet transport air- 
craft possess the airspeed flexibility required for an effective 
time -controlled navigation system. Thus a wide variety of jet 
transport aircraft would be acceptable for use in a strategic 
four-dimensional aircraft navigation study. 

The Boeing 707-320B aircraft was selected for use in this 
study primarily due to the availability of a precise and 
accurate mathematical model [6]. The derivation of the equations 
of motion using Newtonian mechanics is standard and is avail- 
able from numerous references [9,10,11]. While the aerodynamic 
forces and moments are based on a standard derivation, the 
physical parameters and aerodynamic coefficients are character- 
istic of the Boeing 707-320B. The equations governing aircraft 
motion relative to certain reference frames are presented in 
this chapter, but an evaluation of the aerodynamic coefficients 
and justification for the assumptions and linearizations used 
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TABLE 3-1 


AIRCRAFT AERO PERFORMANCE DATA 


Minimum Speed [ Maximum’speed' Minimum Speed [Maximum Speet 
iltitudes at Minimum at Minimum at Maximum at Maximum 

(feet) Wt. (KTAS ) Wt. (KTAS ) Wt. (KTAS) Wt. (KTAS) 


aircraft - 


10,000 

21,600 

32.000 

39.000 


aircraft - 


Minimum Weight 
Maximum Weight 


170.000 pounds 

247.000 pounds 



Minimum Weight 
Maximum Weight 


125.000 pounds 

160.000 pounds 



231 

1ST 1 

231 

270 

535 

277 


510 

365 

360 

490 

447 


aircraft - 

ToTooo ” 

22,500 

31.000 

35.000 

aircraft - 


Minimum Weight - 80,000 pounds 


243 n 

407 

243 1 

295 

500 

295 

340 

480 

353 

364 

465 

395 


Minimum Weight 
Maximum Weight 


400.000 pounds 

565. 000 pounds 


10,000 

230 

22,000 

lie 

32,0-0 

328 

39,000 

375 



ircraft - DC -10 


10,000 

25.000 

35.000 

38.000 


aircraft - 720B 


10,000 

22,000 

35.000 

40.000 


Minimum Weight 
Maximum Weight 


270.000 pounds 

370.000 pounds 



Minimum Weight 
Maximum Weight 


145.000 pounds 

175 . 000 pounds 



[4: pp. 212-213] 



















56 


in the development of the model are discussed in detail in 
Corley's study [6]. 


3.1 REFERENCE FRAMES 

The equations of motion of the aircraft are described con- 
veniently by using a relative-coordinate system that has its 
origin at the aircraft's center of gravity. Within the rela- 
tive-coordinate system are three reference frames using the 
aircraft's center of gravity as their common origin. These 
reference frames — wind axes, body axes, vehicle axes — are 
related by the aerodynamic and Euler angles. Each reference 
frame is used for a specific purpose. The aerodynamic forces 
acting on the aircraft are most easily computed in the wind 
axis system, although the total aircraft forces and moments 
are most naturally represented in the body axis system of the 
aircraft. The orientation of the aircraft with respect to 
magnetic north and the "flat" earth is described in the vehicle 
axis system, also known as the Euler ian axis system. 

The relative-coordinate system, or more specifically the 
Eulerian axis system, moves with the linear velocity of the 
center of gravity of the aircraft and can be referenced to an 
inertial-coordinate system described by the earth reference 
frame. The earth axis system has been arbitrarily positioned 
for purposes of this simulation study and describes the posi- 
tion of the aircraft with respect to its origin located on the 
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earth's surface. This earth coordinate system, as depicted in 
Figure 2-7, is convenient for purposes of horizontal and ver- 
tical aircraft navigation. 

The reference frames are well-defined under the following 
assumptions [6,10,11]: 

1. The aircraft is regarded as a rigid body. This is 
not strictly true, but for practical purposes, it is 
valid to consider the aeroelastic effects as neglig- 
ible for the purposes of this study. 

2. The aircraft velocity is below Mach 3.0. This is 
true of all modern jet transports. 

3. The earth's rotation is small compared with the 
rotation of the aircraft vehicle. This certainly is 
valid since the rotation of the earth, w^ = 7 x 10 _5 
rad. /sec., is much smaller than any significant air- 
craft rotation. 

4. The earth is fixed in space and the earth's atmosphere 
is fixed with respect to the earth. In effect, the 
curvature of the earth's surface in space is neglected 
and the earth reference is regarded as a plane fixed 
in inertial space with the gravity vector perpendi- 
cular to this plane. 

5. The mass, moments of inertia, and products of in- 
ertia of the aircraft are time-invariant. In 
addition, the center of gravity of the aircraft is 
fixed. 

6. The aircraft is symmetrical about the plane defined by 

the X- and Z- body axes. Therefore, I =1 =0. 

xy yz 

The wind, body, and vehicle coordinate systems are each a 
set of right-handed, orthogonal axes with the origin at the 
aircraft's center of gravity. In the wind axis system, the 
positive X- axis is coincident with the total aircraft velocity 
vector which is opposite the "relative wind." 


The wind axes 
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are used to compute the aerodynamic forces, lift, drag, and 
side force, that act on the aircraft. 

The body axis system has its positive X-axis coincident 
with the longitudinal axis of the aircraft. The positive 
Z-axis is perpendicular to the "belly” of the aircraft and 
points downward. The X-Z plane is considered the plane of 
symmetry for the aircraft body. The aerodynamic forces are 
rotated from the wind axes into the body axes. The body axes 
are then used to compute the total aircraft forces and racments . 
The total force components, P^, F^, F z , are determined by the 
aerodynamic forces, engine thrust, and gravity. 

The positive vehicle X-axis is coincident with the gravity 
vector. The X-Y plane is "parallel" to the earth's surface. 

3.2 EULER AND AERODYNAMIC ANGLES 

The Euler angles describe the rotation of the body axis 
system into the vehicle axis system by the following sequence 
of rotations: 

1. A rotation ^ about the vehicle Z-axis is the 
"azimuth" angle. 

2. A rotation 6 about the vehicle Y-Axis is the 
"elevation" angle. 

3. A rotation <j> about the vehicle X-axis is the "bank" 
angle. 

The aerodynamic angles rotate the wind axis system into 
the body axis system and are used in calculating the resultant 


aerodynamic forces acting on the aircraft. The aerodynamic 
angles of interest are alpha (a) , the fuselage angle of 
attack of the aircraft and beta (6), the sideslip angle. A second 
angle of attack (o^ ) , which is used in the lift calculations, 
differs from the fuselage angle of attack by an additional 2°, 
the aircraft angle of incidence. A third aerodynamic angle, 
gamma (y ) t is the flight path angle of the aircraft with 
respect to the ground. 

The wind and body axis systems are illustrated in Figure 3-1 
along with the aerodynamic angles. The rotation of the body 
axis system with respect to the vehicle axis system as des- 
cribed by the Euler angles is depicted in the master diagram 
of the axis systems shown in Figure 3-2 [10] . 

3.3 EQUATIONS OF MOTION 

The aircraft equations of motion are characterized by 
force and moment equations that are most naturally expressed 
in several reference frames along with transformation equations 
relating them to each other. Subject to the previously 
stated assumptions, these equations are applicable to any air- 
craft with six degrees of freedom. The linear velocity com- 
ponents (u,v,w) with respect to the body axes are expressed as: 


Fig. 3-1 Wind and Body Axes and Aerodynamic Angles 





0 r ~q u 


SSi? F y + " r 0 P v 


q -p Ol Iwl 


where F , F , and F are the force components determined by 
x y 2 

engine thrust, gravity, and the resultant aerodynamic forces 
after rotation into the body frame. These force components 
along the body axes are expressed as: 


[ F* x cos a 0 -sin a cos 0 -sin 0 0 -DRAG 

1 F„ = 0 1 0 sin 0 cos 0 0 SIDE I 


sin a 0 cos a 


sin 0 cos 0 0 SIDE FORCE 

0 01 -LIFT 


- sin e 

+ Weight cos e sin $ + 


COS 0 cos 


THRUST 


The sines and cosines of the aerodynamic angles, which 
are functions of various airspeeds, are computed using the 
following approximations: 


sin a “ r~- ' a 
T 


cos a 3 


sin B * rr- = 0 
V T 


cos B 5 1 - 


where 


3-7 


V T * total velocity 


= / u 2 +v 2 + w* 


The angular velocity components (p,q,r) written in the 
body axes are expressed as: 



1 

I-- 


r 

I 0 

-I 



XX 

xz 



0 I 

0 



yy 


1 


-I 0 

I 



xz 

zz_ 


L 




r - 

V 

o 

H 

-I 


D 

XX 

xz 


4 


0 I vv 

0 


C 

[ 

yy 





-I „ 0 

I 


1 

- 

xz 

zz 





0 r -q 
-r 0 p 
q -p 0 


3-8 


The linear and angular velocity components along with the 
total force and moment components are depicted in the body axis 
system as shown in Figure 3-3. [9] 

The Euler angles i/i) are computed from the body 

axes angular velocities and are expressed as: 


3-9 




cos 0 

sin <p sin 0 

COS <t> 

sin 9 


V 

■ 

i 







e 

cos 0 

0 

COS <j) cos 0 

-si t; $ 

COS 0 


<5 



0 

sin $ 

cos 

* 


k 


The earth frame position is obtained by integrating the 
s\im of the earth frame true airspeed components of the aircraft 
and the earth frame wind components. The wind velocity com- 
ponents are represented by a horizontal wind component (w^) 
from a specific magnetic direction {^ w ) and a vertical wind 
component (w^) with positive direction downward. The earth 
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l 

E 

i 

?• 

f 

(■ 



u * FORWARD VELOCITY p = ROLLING VELOCITY 

v » SIDE VELOCITY q “ PITCHING VELOCITY 

w = DOWNWARD VELOCITY r = YAWING VELOCITY 

F x = TOTAL FORWARD FORCE L = ROLLING MOMENT 

F y = TOTAL SIDE FORCE M= PITCHING MOMENT 

F z = TOTAL DOWNWARD FORCE N = YAWING MOMENT 


Pig. 3-3 Notation in Body Axes 
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frame wind components are expressed as: 
x w = - w h *cos (4» w - 35°) 


y w = - w h *sin (<J> W - 35°) 

h = - w 
w v 
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The earth frame aircraft velocity components are computed by 
first performing an axis rotation of the body axes velocity 
components into the vehicle frame system using the Euler angles 
and then another rotation into the earth frame system. The 
complete earth frame velocity components are: 


”f • 

X 


cos 35° 

sin 35° 

0 “ 


cos 

* 

-sin 


o' 


cos 9 

0 

sin e" 

* 

y 


-sin 35° 

cos 35° 

0 


sin 


cos 


0 


0 

1 

0 

* 

A 


0 

0 

-ij 


0 


0 


1. 


-sin 9 

0 

cos 6 


0 0 
cos <t> -sin <J> 



V 


~w h *cos U w - 35°)' 


V 

- 

w h ‘sin (i^ w - 35°) 

J 

JW 


- W V 
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Alternatively, the earth frame position could be obtained by 
integrating the polar representation of the aircraft along its 
magnetic course as described by the following set of equations; 


r = 


* = 


lx e *cos ( 1 ^- 35 °) + y e * sin <^-35°)] y^ e 

y • - y 

e e J e e 

2 2 

+ y n 

e J e 
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h = u*sin 6 - vsin <t> cos 6 - w*cos 41 cos 9 - w 


where 4 ; is the magnetic direction of the aircraft from the 


earth frame origin and ^ is the actual magnetic course of the 
aircraft as described by equation 3-9. 

3.4 AIRCRAFT PHYSICAL PARAMETERS 
The aircraft physical parameters which are used in the 
force and moment equations are characteristic of the Boeing 
707-320B aircraft. These parameters are listed in Table 3-2. 

A complete diagram of the Boeing 707 aircraft's flight 
control surfaces is shown in Figure 3-4. However, only 
certain flight controls are available in the aircraft model 
used in this study. The allowable control deflections for 
these controls are summarized in Table 3-3. 


TABLE 3-2 

BOEING 7 07- 3 2 OB PHYSICAL PARAMETERS 1 


Parameter 

Value 

Units 

wing area = S 

3010.0 

ft. 2 

wing span = b 

145.75 

ft. 

mean chord = c 

22.69 

ft. 

weight 

225000.0 

lbs . 

mass 

6988.0 

slugs 

J xx 

3.82 x 10 6 

lbs.-sec. 2 -ft. 

I yy 

4.85 x 10 6 

lbs. -sec. 2 -ft. 

T 

1 ZZ 

8.12 x 10 6 

lbs. -sec. 2 -ft, 

*xz 

0.372 x 10 G 

lbs. -sec. 2 -ft . 


1 


Source 


[ 6 ] 









TABLE 3-3 


AIRCRAFT MANEUVERING CONTROL LIMITS 


Control 

Positive 
Sign Convention 

Maximum 

Minimum 

Elevator 

<V 

Trailing edge up 

+20° 

1 

to 

o 

0 

Rudder 

<V 

Trailing edge right 

+26.5° 

-26.5° 

Inboard 

Ailerons 

({ A> 

Right trailing edge up 

+18.5° 

-18.5° 

Spoilers 

(<S B ) 

Positive deployment 

60 o1 

0° 

Flaps 

<« p > 

Positive deployment 

50° 2 

0° 


1 

6 Bmax = 60 ° “ -283* max [ 0 . , KI AS - 188.] 

2 

flaps deploy fully in 30 seconds 


3.5 ATMOSPHERE MODEL 

Variations in atmospheric temperature and pressure are 
fundamental to the determination of the aerodynamic forces 
and moments. These equations depend upon the atmospheric 
density of the air surrounding the aircraft. The local 
atmospheric density of the air is approximated + by: 


t 

These approximations are based on the U.S. standard atmosphere 
[16] which is approved for international standardization by 
the International Civil Aviation Organization (ICAO) and 
which is used by most nations and major airlines in the world. 
A standard day at sea level: 
temperature - 15° Celsius 

barometric pressure - 2116 lb. /ft. = 29.92 inches mercury 
atmospheric density - .002378 slugs/ ft. 3 
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p = [1 - 1.835* (h/65536 + (h/65536) 2 ] p Q slugs/ft. 3 3-13 


where 


h = altitude in ft. 


P o = sea level density - .002378 slugs/ft. 


Mach number, defined as the ratio of the aircraft's true 

airspeed to the local speed of sound, is also essential to the 

f 

equations of motion and can be approximated by: 


M = 


Mach 


Number (1.69) *661 ~ 


ft 


3-14 


where 


local speed of sound n ,,, 

= 1 - (3.683x10 )*h 3-15 


Sea level speed of sound 


a Q = 1116.4 ft. /sec. 


- total true airspeed of the aircraft in ft. /sec. 


See footnote on preceding page. 
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3.6 AERODYNAMIC FORCES 

The aircraft aerodynamic force and moment equations are 
based on dynamic pressure, aircraft physical parameters, and 
dimensionless aerodynamic coefficients. The aerodynamic 
coefficients for the Boeing 707-320B aircraft have been deter- 
minuted [6] and are presented here for completeness. The 
aerodynamic force equations are: 


LIFT = lPV T 2s K 0 ( M >- 0 +C I.« E ' 5 E +C L{p -( S F- 6 ”» +C L <F _ a -o] 


3-16 


C L (M) - {4.584 - 2.22 (Mach) + 5. 387 (Mach) /radian 
°o 


Cjj = - .0055/degree 


'^ 6 , 


■f° 

.014 


' L6 F-a, 


01432/degree 
0 

1.0811/radian 


« P < 6 ° 
« F > 6° 

«p < «° 

« F > 6° 


DRAG « |p V t 2 S C Dmin (M) + k (M) C L 2 + C D 


gear 


+ C D6F* (6 F*' 6 ° ) 


C Dmin< M > = 


k (M) = 




+ c d 6 

b* 6 b 

] 

.012 




Mach < . 7 

.01233 + . 0033 (Mach- 

.8) 

.7 

< Mach < . 8 

.014 

+ .0371 (Mach- 

.845) 

.8 

< Mach < . 845 

.014 

+ . 1455 (Mach- 

.845) 

.845 

< Mach 

.0524 




Mach < . 8 

.063 

+ .2356 (Mach- 

.845) 

.8 

< Mach < .84 5 

.063 

+ .8333 (Mach- 

.845) 

.845 

< Mach ~ 
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C. = total lift coefficient in brackets in *~qn. 3-16 
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C °gear = * 0105 ( when gear is down) 


C D « 


■C 


0018/degree 


« F < 6° 
<S p > 6° 


C Dx = .000833/degree 
6 B 


SIDE FORCE = |pV T 2 s[cy e *6 + c y 6R ’S R ] 


Cy g = -.917/radian 
Cy g = -.004/degree 
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3.7 AERODYNAMIC MOMENTS 

The aerodynamic moment equations, which determine the 
roll, pitch, and yaw characteristics of the aircraft are: 


L 


ROLLING 1 v 2 
MOMENT 2 P T 


sblc v e 





+ J-pV T Sb 2 



p 


Cig = -.1719/radian 

Ci^^ = .00113/degree 

Ci c = -.0002/degree 
^R 

C^p = -.38/radian 
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M = 


PITCHING 

MOMENT 


“ ¥ V T 2 Sc [ c no + C * a ' a+C *6 E ' & E +C ™6 F ' ^F- 1 * 0 )] 

'mg 


+ JP V T Sc 2 [c nlq +C m .]q 


3-20 


= -048 

c m„ 


= -.955/radian 
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Cm 6 


E 


Cm 


6p 



. 009/degree 


0 


L “.0033/degree 
-29/degree 
-3. 7/degree 


« F < 14 0 
6 f < 14* 


N = 


YAWING 

MOMENT 


- JpV Sb [ C n S - 6 +C n 4R - s R ] 


+ ip V, 


T C n r ‘ 


r 3-21 


C ne 53 .115/radian 
Cn$ R - .0011/degree 
C nr - -.15/radian 


The components of velocity, position, force, and moment 
are presented notationally in Table 3-4. The rotation is con- 
sistent with the reference frames depicted in Figures 3-1, 3-2, 
and 3-3, and note should be taken that a right-hand sign con- 
vention is observed throughout. 

3. 8 THE ENGINE MODEL 

The variation of thrust with altitude and Mach number is 
considered important in time-controlled navigation. The most 
significant engine parameters [6] are maximum and minimum 
thrust. These parameters limit the flexibility in speed 
control of the aircraft which is necessary to ensure precise 
four-dimensional navigation. 
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TABLE 3-4 

NOTATION USED IN EQUATIONS OP MOTION 


Components 

Axis 

Units 

X 

y 

z 

Linear Velocity Along 
Body Axis 

y 

W 

V 

ft ./sec. 

i 

Angular Velocity Along 
Body Axis 

P 

q 

r 

rad. /sec . 

Angular Displacements 
About Vehicle Axis 

4 

e 

<p 

rad. 

Earth Frame Position 

X 

y 

h 

ft. 

Aerodynamic Forces 
Along Wind Axis 

-DRAG 

SIDE 

FORCE 

-LIFT 

lbs . 

Total Force Components 
Along Body Axis 

F 

x 

F 

y 

F 

z 

lbs. 

Aerodynamic Moments 
Along Body Axis 

L 

M 

N 

ft .-lbs. 

Moment of Inertia 
About Body Axis 

I XX 

>1 

>1 

H 

*zz 

2 

lbs. -sec. -ft. 


The range of achievable thrust for the turbofan engine 
modeled in this study was determined [6] from the engine 
manufacturer's performance data over the range of altitudes 
and Mach numbers flown by the Boeing 707-320B. One such per- 
formance graph for the Pratt and Whitney JT3D-1 Turbofan 
Engine at sea level is shown in Figure 3-5. The normal oper- 
ating Mach speeds for the Boeing 707 aircraft are listed in 
Table 3-5 for various altitudes. 
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TABLE 3-5 


BOEING 707 NORMAL OPERATING RANGE 1 


ALTITUDE 

MINIMUM MACH 2 

MAXIMUM MACH 3 

Sea Level 

.17 

.51 

5000 

.17 

.57 

10000 

.33 

.63 

15000 

.37 

.71 

20000 

.42 

.79 

25000 

.47 

.88 

30000 

.53 

.88 

35000 | 

.61 

.88 

40000 j 

i 

.75 

.88 


1 Source: [6s p. 53] 

2 

V re f or initial buffet for 1.3g maneuver 

■» 

Indicated airspeed structural limit converted to Mach 
below 25000 ft. Mach limit above 25000. 


Using the engine performance charts along with the air- 
craft's Mach ranges for each altitude, the following equation 
was derived [6] for approximating the aircraft's thrust varia- 
tion with altitude and Mach: 


T(h,M) = T(h Q 


0 ) + 


3T 

3h 


M=0 


h 



h=h 


M + 
o 


9 2 T 

ahaivi 


M=0 V ' M 
h-h Q 

3-22 


For calculating maximum thrust, let 


Maximum Thrust = T{h,M) 


3-23 


using the following values: 
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■{: 


0 0 < h < 15,000 ft. 

15,000 h > 15,000 ft. 


T(h,0) = 13,800 lbs. 

-.28125 lbs. /ft. 


3T 

3h 


M=0 


3T 

3M h=h 


3 2 T 


3h3M 


M=Q 

h=h 


-7800 lbs. /Mach 
-3125 lbs. /Mach 
+.3117 lbs./Mach-ft. 
+.185 lbs./Mach-ft. 


all h. 


all h. 


h Q = 0 
h Q = 15,000 
h Q = 0 
h Q = 15,000 


For idle thrust, let 


Idle Thrust = Max [T (h,M) , 0] 


3-24 


using the following values: 


h 


o 


T (h , 0 ) 


3T 

3h 


M=0 


3T 

3M 


h =h o 


3 2 T 

3h3M 


M=0 

h“h_ 

o 


0 

L 15,000 
1,000 lbs. 

0 


0 < h < 15,000 ft. 
h > 15,000 ft. 

all h 

o 


all h 0 


-2,000 lbs. /Mach all h Q 


{ 


0 

+.07 lbs./Mach-ft. 


h Q = 0 
h Q = 15,000 


The maximum and minimum thrust variation per aircraft 
engine using the derived approximation is compared to the 
manufacturer's thrust values in Figures 3-6 and 3-7, [6] 


MAXIMUM THRUST PER ENGINE (lbs) 
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Pig. 3-6 Maximum Thrust Variation 




IDLE THRUST PER ENGINE (lbs) 




The dotted lines represent data obtained from the actual simu- 
lation as contained in Corley's study [6] using the thrust 
approximation equation over the airspeed ranges of interest 
for each altitude. 

It is ultimately desirable to relate aircraft throttle 


position (T ) to thrust variation. In general, the throttle 

Jr 


controls engine speed by regulating fuel flow. [12,13] 

Engine speed and thrust are not linearly related, but the air 


flow (W fl ) through the engine may be considered proportional 


to engine speed. [14] Therefore, throttle position can be 
related to thrust by normlizing the airflow for a given alti- 
tude and Mach number. The following relationship between 
thrust and throttle position was derived by Corley: 


Net Thrust _ Idle + / Max _ Idle VThrottle’\ 2 
Engine Thrust \ Thrust ” Thrust / \Positionj * 


. Throttle . , 

- Position p' - 
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where maximum thrust and idle thrust are defined by equations 
3-23 and 3-24. Using the thrust data depicted in Fig. 3-5, 
the actual net thrust per engine, based on the assumption that 
airflow is proportional to engine speed and engine speed is 
proportional to throttle position, is compared to the above 
approximation in Fig. 3-8. [6] 


NET THRUST PER ENGINE (lbs) 


r 


i 

i. 
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14000 

12000 

10000 

8000 

6000 

4000 

2000 

IDLE 


k-MAX 



0.0 02 0.4 


0.6 


IDLE 

T p - NORMALIZED THROTTLE POSITION 


Pig. 3-8 Thrust Related to Throttle Position 
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3.9 REAL-TIME SIMULATION OF NONLINEAR AIRCRAFT MODEL 

The complete Boeing 707-320B aircraft aerodynamics are 
represented by the equations of motion that have been pre- 
sented in this chapter. Using the simulation facilities 
mentioned herein, these equations have been programmed to 
provide a real-time simulation of the aircraft’s aerodynamics. 

In the aircraft simulation program, the aircraft dynamics 
are straight-forward solutions to the equations presented in 
this chapter. The linear and angular accelerations (eqns. 3-1 
and 3-8) and the Euler angle velocities (eqn. 3-9) are inte- 
grated using the trapezoidal rule: 

V n * v n-l + At ' (30 n ‘ Vi )/2 3 ' 26 

The earth frame position is obtained by rectangular integra- 
tion of the earth frame velocities (eqn. 3-11) : 

X n = X n , + At V 3-27 

n n-l n 

The real-time simulation computer program is included in 
Appendix B. The program is documented throughout in order to 
provide its user with a basic outline of its organizational 


structure . 


CHAPTER IV 


DESIGN OF A 4-D NAVIGATION CONTROLLER 

Using the aircraft model previously described and the 
associated atmosphere model, a 4-D strategic navigation 
control regulator has been designed. This controller incor- 
porates two parts: a geographical navigation controller and 

a time navigation controller. Aircraft position, measured 
airspeed, and a route-time profile are the primary inputs for 
a 4-D navigation control system. Only navigation in the 
vertical plane is considered in this study. Vertical and time 
navigation are accomplished by controlling aircraft airspeed 
and descent rate. 

In this chapter, a linear discrete-time system describing 
the aircraft's longitudinal aerodynamics is formulated from 
the complete nonlinear continuous-time system. Considerable 
care was exercised to make the aircraft linearization faithful 
to the basic aircraft physics while at the same time to make 
the controller compatible with the simulation: dynamic 

linearization requires fore knowledge of the nominal trajec- 
tories whereas the real-time simulation uses step-by-step 
integration of the aerodynamic equations. Using optimal 
linear quadratic control techniques, as available from numerous 
references (see for example 19, 20, 21], a cost function is 
formulated and an optimal linear feedback control solution is 
derived for application to time-controlled navigation. 




t 
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4.1 LINEARIZATION 

The equations of motion as expressed by equations 3-1, 

3-8 , 3-9, and 3-11 are nonlinear in that they contain products 
of the dependent variables as well as dependent variables that 
appear as transcendental functions. These nonlinear equations 
of motion can be expressed in the following form: 


X(t) - F (X(t) , U(t) , W(t)) 


4-1 


where the state vector is 


’ u " 


forward body velocity 

V 


side body velocity 

w 


downward body velocity 

p 


roll angular velocity 

q 


pitch angular velocity 

r 


yaw angular velocity 

6 


pitch angle 

♦ 


bank angle 

* 


heading angle 

X 


X-axis earth position 

y 


Y-axis earth position 

h 


altitude 


the control vector is 


T 


thrust 

6 e 


elevator deflection 



leron deflection 

V 

i 

rudder deflection 


! i 

r | 

1 ! 

spoiler deployment 

6_ 

F 

^ t ap deployment 


and the exogenous wind vector is 


34 



vertical wind 
horizontal wind from i|> w 

The states, controls, and exogenous variables are functions of 
time although this is not explicitly indicated. 

The particular design problem of this study concerns 4-D 
navigation in the vertical plane from cruise altitudes to 
10,000 feet above sea level. For the design applicable to 


W(t) = 


w. 


vtx. 


these flight conditions, the following assumptions are made: 

1. Since navigation is in the vertical plane, the 
following states can be considered constant: 

v-p = r= (p = 0. 

iji = initial aircraft magnetic course 

2. The following controls can be considered constant for 
the flight conditions considered in this design: 

5 A - { R - 6 B = S F - 0- 

The use of spoiler deployment, 63 , is acceptable, but 
it is considered as an inactive control in this design 
as its application is usually limited to special 
flight conditions. 


3. 


The drag coefficients c D m ^ n and k vary with u, w, and 

h, but their variation is small enough so that it may 
be neglected: 

0.012 < C D . < 0.014; 0.0524 < k < 0.063; Mach < .845 


4. The slope of the lift coefficient curve, 


varies 


significantly with u, w, and h, and this variation may 
not be neglected: 

3.925 < Cl < 6.584; 0.2 < Mach < .845 
- o 0 - 


It is essential to include states in the system that 
describe aircraft position since the primary objective of time- 
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controlled navigation is to place the aircraft at specified 3-D 
geographical locations at specified times. The x and y earth 
frame coordinates can be combined to create a range state 
r = r e (as described by equation 3-12). In addition the earth 
frame origin can be translated to the initial approach fix so 
that the range reflects the horizontal distance of the aircraft 
from the IAF. For navigation in the vertical plane, both the 
range and altitude states can completely describe the aircraft 
position from the IAF along the constant magnetic course of the 
aircraft. 

Therefore, for application to the particular navigation 
situation considered in this study, the nonlinear system can 
be reduced and written in the following form: 

x(t) = f (x(t) , u ( t ) , w(t)) 4-2 

where 



u 






w 


T * 


w 

x(t) = 

q 

0 

h 

r 

u(t) = 

_ 6 E_ 

w(t) = 

V 

W. 

L h J 


Let the following notation be used throughout this study: 

x 3 = x°(t) = nominal state vector 

u° = u°(t) = nominal control vector 

w° = w°{t) = predicted or nominal wind vector 
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6x = x ( t ) - x (t) = 


6u = u(t) - u (t) = 


6W = W (t) - w (t) = 


the incremental difference between the 
actual and nominal states; the state 
perturbation vector 

the incremental difference between the 
actual and nominal controls; the 
control correction vector 

the difference between the measured 
and predicted winds 


Using a Taylor series expansion, we linearize as follows; 

4-3 


x° + fix = f(x° + fix, u° + fiu, w° + 6w) 


o o ,o> 


af 

af 

af 


* 5 * + au 
X = x° 

' 6 - + aw 
x = x° 


u = u u 

u — u° 


li 

»l 

w = w° 

higher order 

terms 


Neglecting the higher order terms. 


* 6w 

x = x° 
u = u° 
w =w° 


af 

m 

fix 

3f 

+ — H 


• 6u 

+ 

af 

• 6w 

4-4 

” 3x 

O 


3u ! 




3 W 

o 


* A • 

OX 

+ 

B • fiu 

+ 

D 

• 6w 

4-5 


where 


A = — 


af 

3x 


af 

af 

n — _ 


- 3ll 

r - 3w 

o — 

o — 


4-6 


are in general time-varying matrices. 
Expanding equation 4-4, we have: 
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Using the aircraft's dynamic equations as presented in 


Chapter III, along with the previous assumptions, the above 
partial derivatives can be expanded. A discussion pertaining 
to the derivation of the nominal state and control trajectories 
as well as the actual values of these trajectories which are to 
be used to evaluate the above partial derivatives will be pre- 
sented in Section 5.1. The general expressions for the partial 
derivatives in equation 4-7 are as follows: 
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a = i£ = 

a 62 3 w 


- sin 9 


4-39 


4-40 


= u sin 0 - w cos 9 


4-41 


where 


3 Thrust ^ 
3u 


u(-2000+.05(h-10,000)) 1 / 2 

(4) (1.69) V (661. - . 002434h) { 1 " T p 

1 J 

u(-3125+.12 (h-10,000)) "j 2 
+ {4) (1.69) V T ( 6 61. - . 0 0 2 4 3 4 h ) i T p 
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4-44 


h > 10,000 ft. 


"^Several coefficients in the maximum and idle thrust approxi- 
mation equations, as described by equations 3-23 and 3-24 
respectively, were slightly modified to ensure a valid 
linearization for all altitudes of interest above 10,000 feet. 
For both thrust equations, h Q = 10,000 for h> 10.000 ft. and 

3^T _f+.12 lbs . /Mach-ft . for maximum thrust 

3h3M M=0 J+.05 lbs . /Mach-ft . for idle thrust 

h=h o =10 ,000 
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w (-2000+ . 05 (h-10,000)) 
(1.69; V T (661.-, 0024 3hr 


1 - T 


[*(-3125+. 12(h-10, 000}) ] 2 

+ (4) (1.69) V T { 661 . - . 0024 34h) T p 

h > 10,000 ft. 
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Given the linearized continuous-time system as described 
by the equations presented in this section, the equivalent 
discrete-time version of the system has been formulated for 
real-time simulation purposes. This formulation and its 
solution is described in the following section. 

4 . 2 THE DISCRETE-TIME LINEAR MODEL 

The discrete-time equivalent to the continuous-time 
linear system is more practicable f’..n direct integration of 
the continuous-time system when considering the actual physical 
implementation of the system. This discrete-time system is 
the sampled-data version of the continuous-time system. 

As derived in the preceding section, the continuous-time 
linearized system is expressed by: 

6x{t) * A(t)6x(t) + B{t)6u(t) + D (t) 6w(t) 4-72 


Q-2. 
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Using the Variation of Constants Formula [22] , the solution 


to the continuous-time linear system is given by: 

t 

_ ' ' ‘ ‘It 

0 


<Sx ( t ) = ^(t, t Q ) sx (t Q ) + J 'Mt,t)B{t) 6u(x)di 


j £(t,t)D(x) <5w( T )di 
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An approximately equivalent discrete-time linear system is 


6 -k+l ~k S ~k + ^k 6u k + -k 6 -k 


4-74 


where 


l k - *<t k+ 1 -t k ) -- e 


^k <t: k+l t k ) 


A, A TT — i A n 

= ^ "I *£ HT 


n=0 
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G,_ = 


r k+1 f fc k+l A.(t k , -t) 

J i (t k+l' T ^(T)dr = J e K K+1 dxB k 


= y a» 


n+l 


B. 


Z_, ^k (n+l) ! -k 
n=0 
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58 


»k 


■ / 


k+1 


5.( t k+ l' T )S(T)dT 


/ 


k+1 -k (t k+l~ T> , 

e . d 'B k 



n=0 


A n+1 

A p 
(n+1) ! ^k 
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A = t k+ ^ - t k = time interval 


and 


A k = A(t k ) B k = B(t k ) D k = D(t k ) = D 


4-78 


4-79 


will be considered constant over the time interval from t k to 
t k+ ^ since their time-variation is slow relative to the system 
time-constants . + 

The time interval, A , was chosen to be 3 seconds. The 
length of this time interval is very important. If the time 
interval is too large, this will imply that the control action 
is "sluggish" and subsequently will not allow the control to 
respond as quickly to a disturbance. Also, a large time step 
will tend to degrade the discrete-time system approximation to 
the continuous-time equations. On the other hand, if the time 


The above expressions are function-space approximations to 
the Peano-Baker series expressions {22] for the transition 
function and were verified to be quite accurate in the present 
application . 
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interval is too small, the system may develop what is known as 
quantization instabilities — these can result from consecutive 
corrective control commands without allowing sufficient time 
between commands to give the system enough time to respond, 
thus causing quantization errors to integrate. The 3 second 
time interval used has shown to be satisfactory in view of the 
aircraft’s time-constants. The nominal state, control, and 
wind values, along with their corresponding discrete-time 
linear system matrices are presented in Appendix A for several 
selected times. 

4 . 3 THE LINEAR FEEDBACK LAW AND RICCATI EQUATION 
We desire to obtain a discrete-time linear feedback law 
whereby the deviations of the control are a function of any 
deviations in the state as well as a known deterministic dis- 
turbance. In particular, we wish to find an optimal feedback 
law of the form 

~ — k^— k + -k^-k* 4-80 

Consider the linear discrete-time system 

SXfc-H = l!k 6 -k + ^k 6 -k + H k 6 -k k=0 , 1, . . . ,T-1 4-81 


and the quadratic cost functional 



+ Su^Rj^u] + ^0^^ 

4-82 

T-l 

= L(6x k ,6u k ) + ^(6 x t ) 4-83 

k=0 

where the weighting matrices possess the following properties: 

> 0 for all k=0 , 1, . . . ,T-1 

4-84 

R k >0 for all k=0, 1, . . . ,T-1 

Or > 9. 

In equation 4-81, 6w k is viewed as a known deterministic 
disturbance. In order to derive the discrete-time linear 
feedback law, state augmentation is used to yield the following 
system: 
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L{ 6^,60^) = fiXvQ,,6x v + <5X 1 ;S V 6U 1 „ + Su^S^Sx 


-k— k — k 


k-k -k — k— k — k 




Using the Dynamic Programming algorithm [19,20], we 
proceed to derive the discrete-time linear feedback law. At 
time k, define the optimal cost-to-go as: 


V*(6x k ) 


<5u k * * * 1 


x i 

L (6x k ,6u k ) + ^ L (<5x t , <5u t ) 


t=k+l 


+ 


= mm 

6u,_ 


[U6^,5u k ) ♦ V*(6£ k+1 )] 


with boundary condition 


V*(6x t ) = <p(5Xg,) = the terminal cost 


We guess that the optimal cost-to-go at time k is of the form 


V (6x k ) = 6x k PkSx k + P k 


with 
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V*(6x t ) = (6 x t ) = Sx^Q t 6x t 
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SO 


-T 


and 


P T = 0 
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Now, assume that the optimal cost-to-go at time k+1 is 


V t6 ^k+l ) k+1— k+l* 5 — k+1 + p k+l 


4-98 


Equation 4-95 will be proved by induction. 

Substituting equations 4-89, 4-91, and 4-98 into 
equation 4-93 we have the following expression: 


V (6x, ) = min 
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Minimizing the cost-to-go at time k by setting the partial 
derivative of V(<5x k ) with respect to equal to zero yields: 
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3V(6x.) 

as ~~ = 6 ^k + ^k**k + (6 ^k + 5 -k-k } ^k+l-k 
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= 0 


Since is positive definite and G^P^^G^ is at least positive 
semi-definite, then (R^ + G^P^^G^) is invertible* and we can 
solve for Su£ to obtain the optimal linear feedback control 
law: 


- - [*i 


■k + -k-k+l-k 


Hfck + 


^k+A^k + -k+l 5 ^k]j 


4-102 


which is precisely in the desired form 6u£ = — k 5 — k + ^k^* 5 — k^ 
where 
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ik< s !>k> - - [«k + 5kP k+ i5k]" 1 + ?*k + iA 


4-104 


^Second order conditions show this to be a minimum. Uniqueness 
can be proved by completion of squares. 
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Substituting equations 4-90 and 4-102 into equation 4-99 
gives the optimal cost-to-go at time k: 


V* (5x u ) 
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and by equating equations 4-105 and 4-107, we obtain the 
following relationships: 

1. The Discrete-Time Matrix Riccati Equation. 
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with Lr = Or 


2. The Driving Function. 


-k 6 -k -k d -k-l 


■ t*i- (S k + !^P k+1 5 |t )(R k + G i P k+1 G (- 1 G£] X 




4-110 


with N t = 0 


3. The Scalar Term. 
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Summarizing the results of this section, the discrete- 
time linear feedback law and the appropriate matrix Riccati 
equation and driving function have been derived. These are the 
necessary tools for designing the four-dimensional control 
regulator . 

4.4 OUTLINE OF ALGORITHM FOR COMPUTING OPTIMAL FEEDBACK LAW 


Combining the results of each section in this chapter, 
the following outline is a step-by-step procedure to determine 
the optimal feedback law to be implemented in the 4-D naviga- 
tion system: 

1. Derive the nominal state and control trajectories. 

2. Evaluate the continuous-time A, B, and D linear 
system matrices along the nominal trajectories 
for each time interval. 

3. Compute the discrete-time F . , G^, and H. linear 
system matrices which are the sampled-data version 
of the continuous- time linear system. 

4 . With knowledge of the weighting matrices and wind 
components, iterate the discrete-time matrix Riccati 
equation (eqn. 4-109), the driving function (eqn. 
4-110), and the scalar term (eqn. 4-111) backwards 
in time. 

5. Compute the feedback gains (eqn. 4-103) and the 
feedback exogenous components (eqn. 4-104) to be 
used in the optimal feedback law (eqn. 4-102) 
during each time interval. 
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CHAPTER V 

EXPERIMENTAL RESULTS 

The simulation facilities utilizing the Adage digital 
computer as described in Chapter I were used to compute and 
test the linear feedback solution on the complete nonlinear 
aircraft model. The Boeing 707 cockpit simulator provided 
ideal conditions for observing the response of the aircraft in 
a real-time simulation. The displayed aircraft instruments 
indicated the response of the aircraft to the action of the 
control regulator in the presence of winds. 

The computer programs used in each step of the design 
process are included in Appendix B, along with appropriate 
documentation. These programs are included primarily for the 
purpose of aiding successive researchers. 

5.1 NOMINAL STATE AND CONTROL TRAJECTORIES 

The strategic control descent route profile as described 
in Chapter II along with the strategy for generating the route- 
time profile corresponding to a desired time of arrival at the 
initial approach fix is used in the simulation. The ATA at 
the IAF was chosen to be 19.73 minutes. The associated route- 
time profile satisfying the aircraft boundary conditions 
depicted in Figure 2-7 is shown in Table 2-2. Using the 
simulation facilities, this route-time profile was "flown" by 




109 


a pilot using the complete nonlinear aircraft model along the 
desired descent path- The nominal state and control tra- 
jectories were recorded and are depicted in Figures 5-1 through 
5-8. This procedure ensured nominal trajectories which were 
consistent with the nonlinear simulation, thus improving the 
accuracy of the linear model. 

The route-time profile was designed for the presence of 
no wind and was "flown" as such. The execution of the route- 
time profile was not done by an automatic system, but rather 
by pilot control. The pilot "error" inherent in the nominal 
state and control trajectories from those ideal trajectories 
dictated by the route-time profile can be considered 
negligible since it is the recorded trajectories against which 
the error signal of the controller is measured. 

5.2 WIND DISTURBANCES 

The wind dx. _urbance, 6w^, which appears as an exogenous 
variable in the linear discrete-time system, is treated as a 
known deterministic disturbance. This wind disturbance is the 
difference between the nominal wind (that wind predicted and 
used to determine the aircraft's route-time profile) and the 
actual or measured wind. In reality, winds are not deter- 
ministic and must be estimated; this study does not consider 
this problem but one can view the winds used here as if they 
were the solution to an estimation problem. 



(FEET/SECOND) ^ (FEET/SECOND) 
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Pig. 5-1 Nominal Forward Body Velocity - State u 



Pig. 5-2 Nominal Downward Body Velocity - State w 


q° (RADIANS/SECONO) 
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Fig. 5-3 Nominal Pitch Rate - State q 



Fig. 5-4 Nominal Pitch Angle - State 0 


(NAUTICAL MILES) h ( EEET ) 


112 



Fig, 5-5 Nominal Altitude - State h 
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In this study, the route-time profile is designed in the 
presence of no wind. Therefore, Sw^ is the actual wind that 
the aircraft encounters in flight. Three different actual wind 
conditions are used in this study. Each wind is a direct head- 
wind and is constant along the entire descent path. The winds 
used are 15, 30, and 45 knot head-winds. The system was de- 
signed to handle vertical winds also, but these are not con- 
sidered in this study 

Since the route-time profile assigned to the aircraft is 
based on a groundspeed profile, the effect of the wind dis- 
turbance, <5w, , is to alter several of the nominal state tra- 
jectories with an additional component, Ax°, in order to main- 
tain the groundspeed profile which is required to achieve 
accurate 4-D navigation. The nominal attitude and range state 
trajectories remain unchanged under wind disturbances for a 
particular route-time profile. The most important change 
occurs in the aircraft nominal forward velocity state. This 
change, is equal to the horizontal component of the wind 

(-Wh) along the aircraft's ground track. For example, since a 
head-wind is assumed to be negative, the change in the nominal 
forward velocity trajectory is positive in order to compensate 
for the head-wind and remain on a desired groundspeed profile. 
The changes in the aircraft's nominal downward velocity, pitch 
rate, and pitch angle states are a result of the change in the 
nominal forward velocity state. These changes are small 
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and neglected in the nominal state trajectories. However, if 
these nominal state trajectories were adjusted to account for 
these small changes, the errors sensed by the feedback system 
would be reduced for these states. 

5.3 PERFORMANCE WEIGHTING MATRICES 
Perhaps one of the most important aspects of the design is 
the choice of the weighting matrices Q, R, and S. This choice 
is initially based on the desired maximum allowable deviation 
of the states and controls from their nominal values at any 
instant in time [10,20,21]. The maximum and minimum values of 
the nominal state and control trajectories, and the desired 
maximum allowable deviations along these nominal trajectories, 
are listed in Table 5-1. 


TABLE 5-1 


ACCEPTABLE STATE AND CONTROL DEVIATIONS 



Maximum 
Nominal Value 

Minimum 
Nominal Value 

Allowable 

Deviation 

Units 

States - 

u 

804. (+ au°) 

480. (+Au°) 

±10.0 

ft . /sec . 

w 

33.5 

7.7 

±2.0 

ft . /sec . 

q 

0.0049 

-0.0058 

±0.001 

rad . / sec . 

0 

0.051 

-0.0425 

±0.01 

rad. 

h 

35000.0 

10000.0 

±200 . 0 

ft. 

r 

125.4 

0.0 

±0 . 1 

n . mi . 

Controls 



T 

12198.0 

0.0 

±500.0 

lbs. 

5 e 

0.127 

-4 . 32 

±2.0 

deg . 
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The selection of the weighting matrices in the quadratic 
performance function is by no means a simple task. Usually, 
they are selected by the designer on the basis of experience 
and readjusted accordingly based on the results of simulation 
runs [19]. For most practical applications, Q and R are 
selected to be diagonal as they have been in this study. This 
allows specific components of the state perterbation vector 
to be penalized individually. This is a common rule of 
thumb applicable to aerospace systems that have a "physical" 
set of state variables and control variables [19] . 

The particular design considered here is particularly 
applicable to passenger-carrying airline transports. There- 
fore, from a practical viewpoint, the levels of acceleration 
or deceleration produced by any maneuvers must le acceptable to 
avoid discomfort in the passenger cabin. This leads to a high 
penalty on pitch rate. In order to preserve the accuracy 
desired in 4-D navigation, high penalties on altitude, range, 
and particularly on forward airspeed are imposed. In addition, 
in order to regulate these states about the nominal trajectory, 
it is desirable to use elevator deflection rather than thrust 
in order to minimize the cycling up and down of the engines, 
thus minimizing fuel consumption. Therefore, thrust is penal- 
ized more heavily than elevator deflection. The cross-term 
weighting matrix S is used to smooth the performance of the 
control regulator. 
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Using the simulation facilities, the linear feedback con- 
trol system's response to various wind conditions imposed upon 
the nonlinear aircraft model was evaluated in a real-time 
simulation. After much frustration and "juggling" of the 
weighting matrices, it was found that the following matrices 
produced acceptable responses to wind disturbances: 


state 

Qj^ = weighting 
matrix 



0 

.5 

0 

0 

0 

0 


0 

0 

. 8E+3 
0 
0 
0 


0 0 0 

0 0 0 

0 0 0 

. 75E+2 0 0 

0 . 88E-2 0 

0 0 . 55E-5 


5-1 


control 

5k = weighting 
matrix 


. 39E-4 
0 


0 

. 11 


5-2 



- 

. 53E-2 

0 

cross-term 

. 44E-2 

0 

= weighting — 

0 

. 94E+1 

matrix 

0 

. 28E+1 


0 

. 31E-1 


. 15E-4 

0 


5-3 


terminal 
Op = state 

weighting 

matrix 


. 1E+1 

I 0 
0 
0 
0 
0 


0 
. 5 

0 

0 

0 

0 


0 

0 

. 8E+3 
0 
0 
0 


0 0 0 

0 0 0 

0 0 0 

. 75E+2 0 0 

0 . 99E-2 0 

0 0 . 44E-4 


5-4 


Note that higher penalties are placed upon the forward 


velocity, altitude, and range states at the terminal time in an 
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attempt to preserve the accuracy and precision inherent in the 
time-controlled navigation concept. 


5.4 THE OPTIMAL FEEDBACK SOLUTION 

Using the nominal state and control trajectories along 
with the weighting matrices described in the previous sections, 
the optimal discrete-time feedback law with the appropriate 
Riccati equation and driving function as derived in Chapter IV 
can now be solved. The discrete-time versions of the Riccati 
equation and driving function as described by equations 4-109 
and 4-110 respectively are solved backward in time. For each 
time interval of 3 seconds, new solutions to these equations 
are computed and used to update the feedback gain matrix 
and exogenous component ^(^w^.). These matrices are used in 
the linear feedback law 6u* = K ^ <5 
constant during the following 3 second interval in the real- 
time simulation. 

The solutions to the Riccati equation and the resulting 
feedback gain and exogenous component matrices are included in 
Appendix A for the initial time interval and the time interval 
immediately preceding the terminal time. 

The optimal feedback gains are time-varying, but their 
values are unaffected by the value of the wind disturbance. 
However, the values of exogenous feedback terms are directly 


x^ + f-^Sw^) and remain 
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proportional to the magnitude of the wind disturbance at any 
instant in time. The optimal feedback gains for each control 
corresponding to the appropriate states are depicted in 
Figures 5-9 and 5-10 as a function of time. It is important 
to consider the relative magnitudes of the deviations in the 
states in order to interpret the relative strengths of the 
gains required for each control. These deviations in the 
states will be considered in the following section. 

In addition, it is important to notice the change in the 
feedback gains at certain times in the flight, namely at those 
times when the initial descent begins (at time Tl) and ends 
(at time T3) as well as at the terminal time (ATA) . At times 
Tl and T3, the most noticeable changes in the feedback gains 
occur for those gains multiplying the deviations in the down- 
ward velocity, pitch rate, and pitch angle states. This is 
logical since it is at these two particular times that the 
nominal values of these particular states are changing most 
rapidly due to the desired change in orientation of the air- 
craft in order to stay on the descent path. Overall, the most 
radical changes in the feedback gains are noticeable at the 
terminal time due to the terminal time penalties on the states. 
In general, the feedback gains near the terminal time are 
acceptable. However, the rate of change in magnitude of the 

Assuming constant wind, = s v. 




DEG/FT DEG/TT DEG/RAD DEG-$£C/fcAD DEG-SEC/FT DEG-SEC/FT 
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feedback gains near the terminal time could be reduced by 
artificially extending the terminal time in order to achieve 
less change in the gains near the true terminal time. Ulti- 
mately, this would be desirable when extending the time-con- 
trolled navigation concept completely down to the runway 
threshold. 

The exogenous feedback control components are depicted in 
Figures 5-11 and 5-12 as functions of time. The exogenous 
components of the feedback control, which are directly related 
to the magnitude of the wind disturbance, are designed to com- 
pensate for the overall disturbance along the descent route 
profile. These components tend to decay linearly to zero with 
respect to time. This is a result of the method of solution 
chosen to determine the exogenous feedback components. The 
solution is designed to minimize the total additional control 
provided by the exogenous components. 

As an alternative to this method of solution, the exogenous 
components could be determined as the additional control, 

Au£, needed at each instant of time to keep the states of the 
system on their adjusted nominal trajectories, x£ + Ax£, based 
on the wind disturbance as previously described. Although the 
second method was not investigated in this study, it is possible 
to qualitatively compare the two solutions while examining the 
results of the system's response using the first method of 
solution. The possible advantages of this second approach were 
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Fig- 5-12 Exogenous Feedback Elevator Component 



only apparent in the final simulation results and tire was 
insufficient to permit a full evaluation. The results of the 
approach taken in this study will be presented in the following 
section. The feedback gains remain unchanged using either 
method of solution for the exogenous feedback components. 

5.5 TIME-CONTROLLED NAVIGATION EVALUATION 

The optimal control solution obtained in the form of a 
feedback law was evaluated in a real-time simulation by intro- 
ducing wind disturbances into the state of the system. As 
previously explained, the linear feedback law is composed of 
two parts: one part dependent upon deviations in the state and 

another part dependent upon the exogenous wind variables. Both 
the complete linear feedback system and one without the exo- 
genous component were analyzed under identical wind distur- 
bances. The important point to note is that the linear feed - 
back law was implemented on the complete nonlinear aircraft 
model . 

The absolute deviations of the states and controls from 
their nominal values, when the complete linear feedback system 
with its exogenous components were implemented on the non- 
linear aircraft system, are depicted in Figures 5-13 through 
5-20 for the various wind disturbances. The deviation in the 
aircraft forward body velocity, <5u, is based on the adjusted 
nominal trajectory due to the wind disturbance. The deviation 
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Fig. 5-15 Deviation in Pitch Rate 
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Fig. 5-16 Deviation in Pitch Angle - 50 
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in pitch rate, <$q, is basically indistinguishable for each head- 
wind disturbance and has a mean value of approximately zero. 
Although the deviation in pitch rate appears to be "noisy," it 
is actually a deterministic deviation. 

5.5.1 ACCURACY ACHIEVED 

The objective of the control regulator is to get the 
aircraft to the IAF at the assigned time. For each head-wind 
condition, the initial deviation in the forward velocity state 
is equal to the magnitude of the head-wind. The controller 
senses this initial deviation and increases thrust to increase 
the airspeed. Meanwhile, the aircraft has fallen behind 
schedule while it was flying at airspeeds below its adjusted 
nominal. Therefore, in order to compensate for the distance 
lost, the controller increases the aircraft's airspeed even 
further. It is important to understand the control regulator's 
action concerning this speed control. The regulator uses over 
50% of its total additional thrust within the first 5 minutes 
of the flight. The additional thrust after 5 minutes into the 
flight stays approximately at a constant level until decreasing 
toward zero at the terminal time. The effect of using the 
additional thrust in this manner is to put the aircraft ahead 
of schedule along its ground track early in the flight by using 
large amounts of additional thrust while at high altitude and 
then letting the aircraft slowly approach the nominal schedule 
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while using smaller amounts of thrust at lower altitudes. The 
effect of this action on the deviation in range is depicted 
in Figure 5-18. 

The advantage of this type of control action lies in 
fuel conservation since more thrust can be achieved at higher 
altitudes than can be achieved at lower altitudes for the same 
fuel flow. 

The effect of the exogenous feedback solution component 
can be seen from the data presented in Table 5-2. When the 
exogenous component is included in the feedback solution , the 
control regulator achieves the desired 4-D navigation accuracy 
at the terminal time. For a 15 knot head-wind, the aircraft is 
17 feet ahead and 76 feet too high of the desired point at the 
terminal time. The aircraft is 20 feet behind and 151 feet too 
high for a 30 knot head-wind, and 41 feet behind and 212 feet 
too high for a 45 knot head-wind at the terminal time. These 
errors in aircraft position at the terminal time are certainly 
acceptable since actual position measuring equipment errors are 
greater than those errors produced by the 4-D navigation system, 
designed here. In addition, the aircraft is traveling at 
speeds that could cover the distance errors in less than a 
second. 

However, without incorporating the exogenous component in 
the feedback solution, the aircraft is approximately 1 nautical 
mile, 2 nautical miles, and 3 nautical miles behind at the 



TABLE 5-2 

EFFECT OF EXOGENOUS FEEDBACK COMPONENT 


Time 

Feedback 

Solution 



T1 

T2 

T3 

ATA 

With/Without 

Exogenous 

Component 

With/Without 

Exogenous 

Component 

With/Without 

Exogenous 

Component 

With/Without 

Exogenous 

Component 


15 knot head-wind 


(SU 

(ft. 

/sec. ) 

i5w 

(ft. 

/sec . ) 

<5q 

(rad 

. /sec . ) 

i50 

(rad 

.) 

6h 

(ft. 

) 

<5r 

(ft. 

) 

ar 

(lbs 

.) 


-25.3 

17.8 

0 

-7. 3 

0 

-.0003 

0 

-.0138 

0 

230.5 

0 

-2385 

0 

141 

0 

-1.43 


-1.5 
-4 . 


0002 


- 10 . 

-2.3 

-.0025 


320 

-.82 


-.0047 -.0028 


91. 

3204. 

743 

-.62 


Wind - 30 knot head-wind 



(ft ./sec . ) 

6w 

(ft. /sec. } 

Sq 

(rad. /sec . ) 

30 

(rad. ) 

3h 

(ft.) 

<5r 

(ft.) 

sr 

(lbs.) 

66 e 

(deg. } 

Wind =45 knot 

<5u 

(ft ./sec. ) 

<5w 

(ft. /sec. ) 

Sq 

(rad. /sec. ) 

SQ 

( rad. ) 

<5h 

(ft.) 

<5r 

(ft.) 

ST 

(lbs. ) 

SS E 

(deg. ) 



-3.2 

1.1 

-4.4 

-7.9 

-6 . 6 

-5.5 

-.0003 

. 0001 

. 0006 

-.0147 

-.0078 

-.0075 

312 

209 

169 

5031 

-8740 

6406 

675 

1152 

1470 

-1.55 

-1.1 

-.89 


55.9 

- 21.1 


-3.6 

-11.9 


-.0002 

0 

0 

0 

3244 

-.43 


-.0006 -.0005 


10. 3 

-10.3 

.0005 


-6.7 

-9 

-.0006 


.0363 -.0212 -.0118 -.0103 -.0046 -.0027 -.0155 


509 

-1899 

2279 

-3.7 


447 

7765 

1047 

- 2.2 


304 

-10601 

1863 

- 1.6 


256 

9201 

2159 

-1.45 
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terminal time for 15, 30, and 45 knot head-winds respectively. 
These errors are obviously not acceptable for precise 4-D 
navigation since the time required to travel the lost distance 
is too great — for example, it would take approximately 45 
seconds to make up for the distance lost in a 30 knot head-wind 
after reaching the IAF at a speed of 250 KIAS. 

Although it was desired that the aircraft reach the IAF 
at speeds not exceeding 250 KIAS, slightly higher speeds 
resulted. The aircraft was approximately traveling at 257, 

267, and 275 KIAS upon reaching the IAF in the presence of 15, 
30, and 45 knot head-winds respectively. The reason for the 
slightly higher indicated airspeeds is that the nominal forward 
velocity was adjusted for the winds, and thus increased beyond 
the nominal 250 KIAS at the terminal time. Although the ter- 
minal time airspeeds do not greatly exceed the 250 KIAS re- 
quirement, there are two possible methods to remedy this 
situation. One possibility is to adjust the nominal forward 
velocity to account for the wind, yet maintaining a 250 KIAS 
nominal velocity near the terminal time regardless of the wind. 
This approach would satisfy the 250 KIAS speed limit imposed 
by the FAA for flight below 10,000 feet, but would not allow 
certain groundspeeds to be achieved which are the speeds used 
in determining the route-time profile. A second possibility is 
to impose a groundspeed speed limit for strateg ically controlled 
aircraft utilizing four-dimensional navigation so that precise 
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time-controlled navigation is ensured. 

The total forward velocity response and total thrust 
response for feedback solutions both with and without the 
exogenous component in the presence of a 30 knot head-wind are 
indicated in Figures 5-21 and 5-22. It can be seen that the 
aircraft's forward velocity never reaches the desired nominal 
velocity adjusted for the wind and subsequently continuously 
falls behind schedule when the exogenous component of the 
feedback solution is not used. 

From the total thrust response curve it can be seen that 
the thrust stays relatively constant between times Tl and T3. 

In addition, the total thrust is not allowed to exceed its 
maximum allowable value for each altitude and Mach number. At 
35,000 feet, the controller is just inside the thrust satura- 
tion limit for a 30 knot head-wind, but is limited by the 
saturation limit for a 45 knot head-wind. This is also evi- 
dent on the thrust deviations curves in Figure 5-19. When 
the total thrust applied in the nonlinear simulation is limited 
by the saturation limit, less control is applied than that 
desired by the feedback law. Therefore, the controller senses 
larger errors in the states over a longer period of time. How- 
ever, the experimental results from the real-time simulations 
have shown that these errors are eventually corrected for by 
"delayed 1 ' additional control and effectively do not affect the 
accuracy of the 4-D navigation system at the terminal time. 
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5.5.2 COMPARISON OF EXOGENOUS FEEDBACK. COMPONENT SOLUTIONS 

We can now postulate the differences in the system's 
response to each of the two methods for determining the exo- 
genous feedback components which were briefly described in 
section 5-4. The first method, which is designed to minimize 
the overall additional thrust needed to compensate for the 
winds, results in exogenous feedback components that decay to 
2ero at the terminal time. The effect of this method of 
solution can be seen by comparing the exogenous thrust com- 
ponent in Figure 5-11 with the deviation in thrust depicted 
in Figure 5-19. It is apparent that the feedback gains are 
working "hard" to initially increase the additional thrust 
control and then decrease it. This results in an initial 
addition to the exogenous thrust component followed by a 
partial cancellation of it which results in the deviations of 
thrust as depicted in Figure- 5-19. As previously pointed out, 
this action minimizes the overall additional thrust, thus 
minimizing the additional fuel consumed. However, this result 
is achieved by making the aircraft fly faster at higher alti- 
tudes, thus initially placing it ahead of its ground track 
schedule . 

The second method of determining the exogenous feedback 
components by solving for the additional control needed at each 
instance in time to compensate for the head-winds in order to 
follow the adjusted nominal state trajectories would not result 
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in exogenous components that decay to zero. It can be 
speculated that the feedback gains would not. exhibit the strong 
time-variation previously required to add and subtract control 
from the exogenous control components. Subsequently, the air- 
craft would remain closer to its nominal ground track position, 
but would do so at the expense of increasing overall additional 
thrust during the flight. The additional thrust would result 
from greater control needed at lower altitudes in order to ad- 
here to the nominal ground track as opposed to the first method 
where less thrust is needed at lower altitudes since the air- 
craft is further along its nominal ground track, and thus 
allowed to gradually "fall" behind to its nominal ground track 
position at the terminal time. 

Therefore, the first method of determining the exogenous 
feedback control components results in overall less control 
than the second method, but does not remain as close to the 
nominal ground track as the second method. However, in either 
case, the desired accuracy at the terminal time can be achieved. 
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CHAPTER VI 

accomplishmen t s, recommendations and conclusion 

The objective of this research was to design and simulate 
a four-dimensional navigation controller to be used by air 
carriers in a strategic air traffic control system. A com- 
plete automatic time-controlled navigation system for aircraft 
is a complex system that must satisfy requirements imposed by 
the FAA and air traffic controllers, be within the performance 
capabilities of the aircraft, and be acceptable to the pilot. 

In this study, only the descent phase of flight was considered. 
It was felt that the greatest need for such a concept was 
within this phase of flight, where derandomization of aircraft 
in time could be most easily accomplished. 


6.1 ACCOMPLISHMENTS 


The accomplishments of this study can be summarized as 
follows : 

1. A strategic control descent profile for aircraft 
arriving at Logan International Airport was designed. 
In addition, a strategy was devised for determining 
possible times of arrival at the IAF and for 
generating the corresponding route-time profile for 
each arrival time. 

2. Using a mathematical model for the Boeing 707-320B 
aircraft, a linear feedback control solution was 
designed to assist the pilot to navigate along a 
fixed linear strategic descent profile. 
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3. A linear feedback control solution was derived for 
strategic four-dimensional aircraft navigation in 
the vertical plane in the presence of known along- 
track wind disturbances. The feedback solution is 
composed of two parts— one part dependent upon the 
deviations in the states and another part dependent 
upon the exogenous wind variables. 

4. The linear feedback control solution for time-con- 
trolled navigation was simulated and tested on the 
complete nonlinear aircraft model in the presence 
of 15, 30, and 45 knot head-winds. The experimen- 
tal results showed that the feedback controller pre- 
served the accuracy required at the terminal time to 
ensure a successful 4-D navigation system. 


6 . 2 RECOMMENDAT ION S 


Many important aspects of time-controlled navigation can 
be considered in further research. The basic recommendation 
is that research and development should be continued toward 
the capability to implement 4-D navigation control systems. 
The specific recommendations that the author feels are parti- 
cularly related to this study are the following: 

1. Examine methods for increasing aircraft descent 
gradient capabilities which would be desirable in 
order to adapt to certain environmental conditions. 
Such methods may include varying the slope of the 
descent path, thus increasing the number of route- 
time profiles that an aircraft is capable of 
executing under such conditions. In addition, the 
effects of spoilers and flaps on the aircraft's 
gradient capabilities can be considered. 

2. Consider a design incorporating all aircraft states 
and controls. This will allow 4-D navigation to 
include turns and to be extended down to the runway 
threshold. 


3 . 


Consider thrust and actuator dynamics in the design 
of the controller. The present study only includes 
thrust dynamics as provided by the cockpit simulator 
hardware in real-time simulation, but no such 
dynamics are included for the corrective control 
produced by the feedback lav/. The effects of con- 
trol saturdiion on the system can also be examined. 

4 . Consider a complete wind model that includes cross 
winds, gusts, and wind shear. Determine a method 
for estimating the mean winds along the entire 
descent path as well as a method for using measured 
winds as real-time input into the system. 

5. The system designed in this study is completely 
deterministic. In reality, the actual system will 
be beset with noises and inaccuracies in observing 
the states as well as unknown winds and pilot error. 
Therefore, a stochastic system employing optimum 
filters might be designed in view of these con- 
siderations. The robustness of the linear feedback 
controller on the nonlinear simulation was gra- 
tifying in this trial study. 

6. Most importantly, the practicability and physical 
implementation of such a system should be analyzed. 
It may be possible to reduce the number of states 
and/or feedback gains in the system without sig- 
nificant loss in acceptable system response and 
performance . 


6 . 3 CONCLUSION 

The single most important conclusion to be drawn from 
this research study is that the design of a time-controlled 
navigation system is feasible. Overall, the potential benefits 
of a strategic air traffic control system utilizing a 4-D 
navigation controller implemented by the airborne guidance 
system are as follows: 

1. Increased air traffic control system capacity. 
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2. Continued operation in the event of ground system 
failure . 

3. A reduction in controller/communication workload. 

4. A reduction in flight time and delays. 

5. More precise aircraft guidance and control resultin 
in increased safety in the airways system. 

6. More efficient energy management resulting in a 
reduction in airline operating costs and fuel 
savings . 

7. Ease of extension of system into the near-terminal 
area and adaptation to area navigation. 
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APPENDIX A 

EVALUATION OP CONTINOUS-TIME/DISCRETE-TIME LINEAR 
SYSTEM MATRICES AND OPTIMAL FEEDBACK LAW 

As described in Chapter IV, the continuous-time 

linearized aircraft system is expressed by: 

6x(t) - A { t) c5 X ( t ) + B(t)6u(t) + D(t)6w(t) A-l 

The equivalent discrete- time linearized system is: 

6 -k+l = -k 5 -k + -k 6 -k + — k 5 — k A “ 2 

The nominal state, control, and wind values, and the 

corresponding A^, B^, D^, F ^ , G^, and matrices are pre- 
sented here for the initial time (k=0) and the time 
immediately preceding the terminal time (k=T-l) . 

The nominal values at time k= 0 and k=T-l are presented 
in Table A-l. 


TABLE A-l 
NOMINAL VALUES 



Nominal 

Values 


Time 

k=0 

k=T-l 


States 


Units 

u 

804.0 

481.6 

ft ./sec. 

w 

11. 0 

21.5 

ft. /sec. 

q 

0.0 

0.0 

rad. /sec. 

0 

0.84 

2.84 

deg. 

h 

35000.0 

10000.0 

ft . 

r 

125.4 

0.19 

n . mi . 

Controls 


T 

12166.0 

11122.5 

lbs . 

6 e 

-4.32 

-0.52 

deg. 

Winds 

w 

V 

0.0 

o 

* 

o 

knots 

•h 

-15.0 

-15.0 



knots ! 

(head-wind) 



i 
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The continuous-time linear system matrices evaluated at 
time k=0, and the corresponding discrete-time linear system 


matrices are: 


A 

-o 




G 

—o 


0.00042 

■ 0.00002 

0.0 

0.0 

0.00005 

■0.00064 


-0.94005 

15.73744 

0.01784 

0.04390 

18.77365 

0.51299 


-0.00414 

0.05196 

-10.99040 

-32.19657 

0.00007 

0.0 

-0.10315 

-0.81116 

803.99660 

-0.47206 

0.00115 

0.0 

0.00007 

-0.00016 

-1.53043 

0.0 


0.0 

0.0 

0.0 

0.0 

1.0 

0.0 


0.0 

0.0 

0.01466 

-0.99989 

0.0 

804.07130 

0.0 

0.0 

_-0. 99989 

-0.01466 

0.0 

0.79753 

0.0 

0.0 





— 






0.00014 

-0.00760 






0.0 

0.55583 





B 

0.0 

0.02974 





— o 

0.0 

0.0 






0.0 

0.0 






0.0 

0.0 






L_ 






0.0 

0.0 






0.0 

0.0 





D = 

0.0 

0.0 





— O 

0.0 

0.0 






-1.0 

0.0 






0.0 

-1.0 






— 





0.97276 

0.06007 

-27.58448 

-95.15870 

0.00032 

0.0 

-0.07036 

0.05726 

73.86335 

7.26394 

0.00144 

0.0 

0.00005 

- 0.00001 

-0.00298 

-0.00349 

0.0 

0.0 

0.00012 

- 0.00010 

0.60162 

0.99574 

0.0 

0.0 

0.33406 

-1.17621 

679.50980 

2398.76550 

0.99766 

0 . 0 

-2.96182 

-0.13724 

26.83525 

145.83422 

-0.00048 

1.0 


A-3 


A-4 


A- 5 


A- 6 


A-7 
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So 


-0.00044 

0.0 

-0.00295 

0.0 

-0.0 

0.0 

-0.0 

0.0 

-2.99714 

0.0 

0.00046 

-3.0 


A- 8 


The continuous-time linear system matrices evaluated at 
time k=T-l, and the corresponding discrete-time linear system 
matrices are: 




F = 
i^T-l 


-0.00523 

0.10339 

-21.32225 

-32.17441 

0.00001 

0.0 

-0.11106 

-0.86153 

481.70050 

-1.28396 

0.00098 

0.0 

0.00052 

-0.00007 

-2.23353 

0.0 


0.0 

0.0 

0.0 

0.0 

1.0 

0.0 


0.0 

0.0 

0.03987 

-0.99920 

0.0 

482.16750 

0.0 

0.0 

-0.99920 

-0.03987 

0.0 

-2.09776 

0.0 

0.0 

— 






— 



— 

— 






0.00014 

-0.02151 






0.0 

0.48601 





®T-1 

0.0 

0.02603 






0.0 

0.0 






0.0 

0.0 






0.0 

0.0 






— 







— 

“1 






0.0 

0.0 






0.0 

0.0 





D m . = 

0.0 

0.0 





— T-l 

0.0 

0.0 






-1.0 

0.0 






0.0 

-1.0 






— 

- 




0.94220 

0.10951 

-22.74816 

-94.38282 

0.00026 

0.0 

-0.00685 

0.06864 

24.97519 

1.31934 

0.00104 

0.0 

30.00022 

0.00002 

-0.00420 

-0.01851 

0.0 

0.0 

0.00057 

0.00001 

0.43522 

0.97549 

0 . 0 

0.0 

0.54402 

-1.04948 

325.67850 

1428.55970 

0 . 99782 

0.0 

-2.92484 

-0.27611 

21.59476 

139.22302 

-0.00041 

1.0 


A- 9 


A-10 


A- 11 


A- 12 
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G, 


T-l 


St-i 


0.00042 

-0.78630 

-0.00001 

6.13034 

0.0 

0.01141 

0.0 

0.02930- 

0.00009 

7.66325 

-0.00063 

0.33018 

— 

— 

— 

— 

-0.00032 

0 . 0 

-0.00219 

0.0 

0.0 

0.0 

0.0 

0.0 

-2.99743 

0.0 

0.. 00038 

-3.0 


A-13 


A-14 


The optimal discrete-time linear feedback law derived in 
Chapter IV is of the form: 

6u* = K k «x k + f k (6w k ) A-15 


where 


K. = [R, + G' P. - G, ] _1 [S' +G' P. ._F. ] 

— k — k — k — k+1— k k — k — k+ 1— k 


V^k> = - f ^k + ^k * k+ A ] ^k [ -k+A 6 -k + ^kti^k ] 


A- 16 
A-17 


The solution to the discrete-time matrix Riccati equation as 
described by equation 4-109, and the resulting feedback gain 


matrix and exogenous component matrix as described by equations 
A-16 and A-17 respectively, are shown here for the initial time 


interval and for the time interval immediately preceding the 


terminal time. For time 0st<3 seconds, 




8.5665 0.1444 -10.6871 
-0.3059 0.5248 -18.9996 
47.1494 -18.9161 14761.6250 


108.5043 -66.4665 46219.8750 
0.3171 -0.0130 9.7914 

-0.0782 -0.0013 0.0586 


-56.0111 0.2888 -0.0263 

-65.1130 -0.0303 0.0009 

45993.6250 12.5613 -0.1113 
155543.2500 43.9428 -0.2136 
36.2019 0.0333 -0.0010 

0.2967 -0.0030 0.0010 


A- 18 
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K = 


-90.9235 -1.7603 183.6018 719.0338 -3.2967 0.2919 

-0.0013 0.0062 -13.0380 -26.0862 -0.0044 -0.000014 


A-19 


f (6W ) = 

— o — o 


3469.7345 

-0.1430 


A-20 


For time 1180 st<T = 1183 seconds. 


£t-i s 


1.8670 0.0947 -13.3580 -59.6059 0 

0.0355 0.5260 -8.3979 -35.3482 -0 

-12.4917 -9.1209 3979.7030 12982.0940 4 


0422 -0.0001 
0143 -0.0 
4608 -0.0015 


-57.2423 -38.9512 13272.5780 54583.2500 19.7873 0.0078 

0.0498 -0.0113 3.9560 17.9359 0.0217 0.0 

-0.0004 -0.0 0.0069 0.0297 -0.0 0.0 


A- 21 




•13.7231 -1.2326 147.1748 764.3848 -0.4423 0.0010 

0.0063 0.0112 -13.9509 -38.5792 -0.0102 -0.000009 


A-22 


-T-l^-T-1* “ 


0.1502 

-0.0004 


A-23 



1 


1 
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APPENDIX B 
COMPUTER PROGRAMS 

The functions of the computer programs used in this study 
are briefly described here for future researchers. All 
possible aircraft times of arrival at the IAF and the corres- 
ponding route-time profiles are computed by "ATA" and "RTP" 
respectively. These programs use the route- time profile 
generation strategy as described in Chapter II along with the 
aircraft velocity profile depicted in Figure 2-6. The times 
of arrival and route-time profiles computed are strictly 
applicable to the descent route depicted in Figure 2-1 for 
the aircraft's boundary conditions as shown in Figure 2-7. 

The complete nonlinear aircraft model of the Boeing 707- 
320B is included in "NV" . The basic structure of this program 
was created by Arye Ephrath for precision approach landings in 
zero-visibility conditions [23]. The program provides a real- 
time simulation of the nonlinear equations of motion as pre- 
sented in Chapter III. The nominal values of the states and 
controls are recorded every 3 seconds and stored in data files 
by "NV" for any flight executed by the pilot in the cockpit 
simulator. These data files are used as inputs to "AB" where 
the linearized continuous-time system matrices are evaluated 
for each 3 second interval. These matrices are then stored in 
data files which are in turn used as inputs for "FGH" where the 
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discrete-time linear system matrices are computed and stored. 
Using the output data files from "FGH," the Riccati equation 
and driving function are solved in "RIC." Using the pre- 
programmed weighting matrices along with a specified wind as 
input, the optimal linear feedback solution is solved. The 
feedback gains and exogenous components to be used by the 
control regulator are stored on data files created by "RIC." 
These data files along with those containing the values of the 
nominal states and controls are used as input for "REG" 
where the linear feedback solution is implemented on the com- 
plete nonlinear aircraft model. The feedback gains and 
exogenous components are updated every 3 seconds. The aircraft 
is "flown" automatically in "REG" using the nominal control 
values combined with the control correction values determined 
by the feedback law as inputs to the nonlinear aerodynamic 
equations. Both "NV" and "REG" provide a real-time simulation 
of the aircraft's aerodynamics using the nonlinear equations 
of motion. 

The remainder of this appendix contains the listings of 
the computer programs used in this study. For further explana- 
tion of the coding of the program, see reference [24] . In 
addition, an explanation of several of the computational sub- 
routines called in "FGH" and "Ric" is provided in reference 
[25] . 
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PROGRAM ATA 
C 

C**+ THIS PROGRAM COMPUTES ALL POSSIBLE TIMES OF ARRIVAL AT THE 
C*+* IAF USING A STANDARD DAV VELOCITY PROFILE FOR A BOEING 707-320B 

C 

WRITE< 10, 100 ) 

100 FORMAT < 3X , " ID VS 3X , 41 TRANS I T I ON " , 3X, “ACC 35" , 3X, 14 ACC 1 0 11 , 4X, "TIME" , 
15X, "TIME 14 ,5X, “TIME 14 , 5X, “TIME* 4 ) 

UJRITEC 10 - 20 0 > 

200 FORMATUQX, “ALTITUDE”, 20X, “AT WP1 " . 3X. "AT W P 2 " , 3 X # “AT (HP 3 41 , 3X , “ AT 

t IAF“ , 

DELT^O . 

DELTT =0 . 

C 

C+*+ INITIAL AND FINAL TRUE AIRSPEEDS ALONG DESCENT ROUTE PROFILE 
C 

VO =476 . 

VF = 280 > 

C 

C*** MAXIMUM AND MINIMUM TRUE AIRSPEEDS ^GR THE ENTRY FIX, 

C*** INITIAL APPROACH FIX, AND CRITICAL ALTIUDES 
C 

VMAX35-496 , 

VMAX25==6l? . 

VMAX 10*415.5 
VMIN35=34S ♦ 

VM INI 0=228 . 5 
C 

o** HORIZONTAL RANGE DISTANCES BETWEEN WAYPOINTS ALONG DESCENT ROUTE 
C 

Dl-31 . 78 
D2=3 1 ,45 
D3-47 . 17 
D4- 1 5 . 

C 

O** DELV1 = VMAX35 - INITIAL DESCENT VELOCITYUDV) 

(>** H2 = TRANSITION ALTITUDE 
C 

DELV 1 ~0 , 

H2=250 00 , 

203 CONTINUE 

Tl*<Dl/< CV0+VMAX35-DELV1 >^2 . > >*60 . 

A = 0 . 

T2-Q . 

DD=0 , 

VA“ VMAX35-DEL V 1 
VB = VA 


ORIGINAL PAGE IS 
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T*.00t 
H=35ClOO . 

RMrtCH = VA/<661 , .002434 
60 D-.5+A*T+T+VA*T 

H=H-‘2 1 8 . *D 
VA = V8 

VB=RMACH* (66 t . - ( , 0 0 24 34 ) > 

A- ( VB-VA VT 
T2*T2*<T*60 . > 

D 0 = D D + D 

I F ( H“H2 >61 , 61 1 6 Ci 

fit A = 0 . 

T3~0 , 

DD=0 . 

VA = VB 
VB = VA 

RIAS=<65fi,-< . 009i*H2> >*RMACH 

62 d=.5+A*T+T+VA+T 
M=H-318 .*D 

va=vb 

VB“R I AS+<661 . , 002434+H> !)/ (656. -( ,0091 +H>> 

A=CVB-VA>/T 

T3 = T2+ < T+60 . ) 

DD=DD+D 

IF<H-IO0OO . >63,63,62 

63 continue: 

T4 = CD4^C<VF + ve>/2. > >*6G . 

ATA=CT1+T2+T3+T4> 

ACC-CCVMAX35-0ELV1 > * ( VMAX35-DELV 1 > -VO *V0 >^( 2.*Dt> 
DEC=< VF*VF~VE:*V8^C2 . * D 4 > 

ACCA=ACC+6090 , /(3600 . *360 0 . > 

DECE=DEC+60G0 > / ( 360 0 . *36 0 0 . ) 

TT22-T1 +T2 
TT33=T 1 +T2+T3 
R IDV-VMAX35-DEL V 1 

WRITE', 10 , 21>RIDV,H2, ACC A, DECE , T 1 , TT22 , TT33 , AT A 
IF < DEL V 1-150 . >24, 20 1, 24 
24 DELVlnpELVl+5. 

GO TO 203 

20 1 I F CH2-350 0 0 . :■ 20 2 , 20 , 20 2 
202 H2-H2+ 1 00 0 . 

GO TO 203 

21 FORMAT < li<,F6. 1 , F 1 0 . 1 ,2X.2F3.3, 4F9.3> 

20 CONTINUE 

CALL EXIT 
END 


ORIGINAL PAGE IS 
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PROGRAM RTF 


C 

O** THIS PROGRAM COMPUTES THE ROUTE-TIME PROFILE FOR A 

c** + particular ata as computed in the program h ata h 

c 

C + +* the PROGRAMMED INPUTS ARE; RIDV = I DV 

C** + H2 * TRANSITION ALTITUDE 

C + + * T 1 = TIME AT UJPi; T 2 = TIME AT WP2; T3 = TIME AT UPS 
C+ + * ATA = ASSIGNED TIME OF ARRIVAL AT IAF 
C 

RIDV=3S6, 

DELV1=49€,-RIDV 
H2 = 250 0 0 . 

T 1 = 4 . 373^60 > 

T2= <. 9 - 0 53/60 . )~T1 
13=06, 793^60 . )-T*-T2 
ATA=19 ,736 
C 

C* + * INITIAL AND FINAL TRUE AIRSPEEDS ALONG DESCENT ROUTE PROFILE 
C 

VO =4 76 . 

VF = 280 ♦ 

C 

C* + + MAXIMUM AND MINIMUM TRUE AIRSPEEDS FOR ENTRY FIX, 

C++* INITIAL APPROACH FIX, AND CRITICAL ALTITUDES 
C 

VMAX35=496. 

VMAX25=51? . 

VMAX10 =4 1 5 „ 5 
VM IN35=346 ► 

VM INI 0=223 , 5 
TTT^O . 

HO =350 0 0 . 

HH=HO 
HF= 1 0 00 0 . 

c 

C++* HORIZONTAL RANGE DISTANCES BETWEEN WAYPOINTS ALONG DESCENT ROUTE 
C 

D 1 =31 . 78 
D 2 = 3 1 .45 
D3=47 . 17 
D4= 1 5 ■ 

UR I TE < 10, 1 0 0 > 

10 0 FORMAT <£X, '’TIME" ,4X, "ALT I TUDE 11 1 5X . M RANGE * , 6X , H TAS" , 7X , "IAS", 6X, 
1"NACH”, 6X, "OH^DT* * x-O 
FLAG 1=0 . 

FLAG2=0 . 

FLAGS =0 . 

FLAG4=0 . 

T=0 . 

16 CONTINUE 
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rtCC«C<VMAX35-0ELVl )*<VMAX35-DELV1 )^V0*V0>/<2 . *D1 > 
IFn-Yi>2,2, 3 

2 V=ACC*T+VO 
D=ACC*T+T/2,+V0*T 
H = HO 

GO TO 10 

3 CONTINUE 

$ I F < T-Tl ~T2 ^ 6 , 6 , ? 

6 IT<FLAG3>95,96,95 

96 IFCFLAGl-J . )6*r 60,66 
66 FLAG 1 = 1 , 

J = 0 . 

RA=0 . 

RT2*0 , 

RDD= 0. 

VA=VMAX35-DELVi 

VB*VA 

RH«350 00 . 

RMACH=VA/<661 002434*RH:0 
RT =.003 
68 CONTINUE 

40 IFC J-10>80, 10 ,30 

80 J=J+1 

RD= . 5*RA*RT*RT+VA*RT 
RH=RH-3 1 3 , + RD 
VA = VB 

VB=ftNiACH*<661 . -< .002434*RH>> 

RA=< VB-VA ) -'RT 
RT2-RT2+RT 
RDD=RC'D + RD 
T = T t +RT2 
H = RH 
P-D 1 +RDO 
V~ VA 

IFCRH-H2)4i, 41,40 

7 CONTINUE 
102 CONTINUE 
95 CONTINUE 

41 IF<FLftG4J97,98>97 
98 IF (FLAGS >90 ,91,90 
91 FLAG£=1. 

FLAG3=i , 

K * 0 . 

R A = 0 . 

RT3=0 , 

RDD-0 . 

Vm=VB 
VB =V A 
PH = H2 

R I AS= ( 656 i - < , 0091 *H2) >*RMACH 


ORIGINAL PAGE 13, 
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90 CONTINUE 

42 IF<K-10> 92 -10,92 
92 K*KM 

. 5*RA+RT*RT+VA*RT 
RH=RH-3l8,*RP 
VA = VB 

VB=R I AS* <66 1 .-< . 00 2434*RH) >/<656,-< . 00 91*RH>> 

RA=< VB'VA>/RT 
RT3=RT 3 + R1 
RDD=RDD+RD 
T=T 1 +T2+RT3 
H=RH 

D=0 1 +D2+RDD 
V = VA 

IF<RH-10000 ,>43-43-42 
101 CONTINUE 

43 CONTINUE 
FLAG4= 1 . 

97 CONTINUE 

9 CONTINUE 

1 1 DEC=<VF+VF-VB + VB;>^<2,*D4> 

V-DEC+ £T*-T1-T2~T3)+VB 

D=DEC*<T-TI-T2-T3>*<T-Tl-T2-T3>/2 . +VB*<T -T 1-T2-T3>+D1 +D2+D3 
H-HF 

!F<D-125. 4)202, 14- 14 
202 CONTINUE 
GO TO 10 

10 TT~T*60 . 

DH=<H-HH) /< TT-TTT) 

TTT = TT 

HH = H 

R= 1 25 . 4-D 

RRMACH-V/ < 661 , -t. 002434*H) > 

RRIA3=<656 . . 0091*H) >*RRMACH 
WRI TE< 1 0 * 15>TT, H, R, V , RRI AS , RRMACH * OH 
15 FORMAT C1X * F5 . 2* 2X, 4F1 0 , 2 * F9 , 3 , F 1 2 , 2) 

T=T+ . 0 1 
J=0 . 
k=0 . 

GO TO 16 
14 CONTINUE 
TT=ATA 
H = HF 
R«0 . 

V=VF 

RIAS=250 . 

RMACH- .44 
DH=*G . 

tlJR I TEC 10, 1 5) TT , H , R , V - R ! AS - RMACH * OH 

CALL EXIT 

END 
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PROGRAM NV 
C 

C++* THIS PROGRAM INCLUDES THE COMPLETE NONLINEAR AERQD YNAM I CS 
C*** FOR THE BOEING 707-320B AIRCRAFT MODEL 

C 

C*** THE NOMINAL VALUES OF CERTAIN AIRCRAFT STATES AND CONTROLS 
C*** ARE RECORDED AND STORED IN DATA FILES AND ATEXT FILES 
C+*+ FOR ANY FLIGHT EXECUTED BY THE PILOT IN THE COCKPIT SIMULATOR 
C 

o** FUNCTION SWITCH 3 STORES LAST SET OF NOMINAL VALUES AFTER STOP 
O** FUNCTION SWITCH 4 RESETS INITIAL CONDITIONS 
C*** FUNCTION SWITCH 3 STARTS PROGRAM 
C*** FUNCTION SWITCH 12 STOPS PROGRAM 

C*+* FUNCTION SWITCH 16 DISPLAYS FLIGHT CONDITIONS AND PARAMETERS AT 
C*** TERMINAL TIME OR AT STOPACTIQN 
£ 

GLOBAL I T I ME i NF 
IMPLICIT FRACTION <F) 

LOGICAL CONE 
REAL FLAPS 

L 0TSERR0R3=SH0ftT 

DIMENSION I BUFF <208} 

COMMON/RELAX/SCORD, SSPAN, SAREA, P > Q* ROW, RMACH, DPP, DQQ, DRR , SPALF 
COMMON/WORK/IJVEL, VVEL , WVEL , VTOT , UDTT, VDTT , WDTT, VTOD 
COMMON^EXTRA/DDFI E , DDTET , DDSY *RFIE,RTET,RSY*STT£T,CTTET,SFIE,CFIE 
COMMON/MORE/SSY , CS Y 

CGMMON/CNTRL/T , FLAPS , CTETA , C-PH I , CXI , GEAR , 3P8RK , TPOS 
COMMON/CNTRL/BTETh, ephi >bxi 
COMMON/PRMTR/V , XI , BET AG > DT 

COMMON/PR MTR/ALP HA , BETA , PH I * VX, VY, VZ, THETA, A , XM # V * R , R I AS 
COMMON/FRAC^FV, FBNK, FP I CH, FA, FVZ, FHDG,FADF, FVOR, FCPICH 
CCMMON/FRhC/FER, FHER, DME<6) , ALT < 7 ) 

COMMON/FD/ADF, VOR, EPS, HER, RAD 

COMMON^ OUT /UU < 1 0 Q ) ,IUWCiOO)#QQ<lO0>j TEET < 1 0 0 > , H H < 1 0 C > , RANGE C 100 '> 
COMMON^ OUT / T P < 10 0) , E E ( 1 0 0 ) , XX ( 7 0 > , Y Y < 70 ) , HH H ( 7 0 ’) , T 0 TXX , L 0 C 1 , L G C2 , 
1TOTT C 1 G 0 ) , TH< 1 0 Cf > ,DIST 

DATA TMRKRl/n , 48 1 5/ , TMRKR2/0 .063/, TMRKR/0 . 0 0 76/ 

DATA TNGSA/-0 . 052933/, RAD/57 * 236/ 

DATA SCO RD/3 4143*/, SSPAN/ 21 9 354 . /,SAREA/1505 . / 

ENTRY NF 
t CONTINUE 

c 

C*** INITIALIZE ALL VALUES 
C 

CT IM=2 10 , 

TOTXX-O . 

LOC t =0 
L0C2=Q 
SPALF = 0 . 

DDF l E=Q . 

DDTET^O . 

DDSY-0 , 
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RfIE*0. 

RTET=, 84/RAD 
RSY*53, 07/RAD 
ST TET -S I N < .015) 

CTTET=COS< .015) 

$FIE=0 . 

CFJE*l, 

SSY=, 79937 
CSY= , 600839 
XI =53 ,07 
PH I =0 . 

FBNK=0 .OF 
ALPHA=2 . 84 
BETAG=0 . 

B£TA=0 . 

DRNG=2550 . 

JJFF=0 
XM=-150 .26 
Y=-239497 . 1 9 
VOR-53,07 
AI>F = 49 . 69 
V=476 . 

YTOT = 80 4 * 

VTOD=0 . 

UVEL=VTOT 
VVEL=0 , 

WVEL= 1 1 ,0 
UDTT = 0 . 

VDTT-0 . 

WDTT = 0 * 

VX=?64 , 65 
V Y = 2 4 3 , 4 5 
VZ = 0 . 

P = 0 . 

Q=0 . 

R = 0 . 

DPP=0 . 

DQQ = 0 . 

DRR=0 , 

THETA=ALPHA~2. 

D I ST^SQRTC < XM+31 . 0826 > **2-K Y/6080 , 2+ , 50 366 > * + 2 > 
A=350 0 0 , 

I ALT 1=3 
IALT2=5 
I ALT3=Q 
I ALT 4=0 
IALT5=0 
LABEL ( ALT ) 

ZSETCO » OF > 

MOVE C , 6 1 F # . 39F > 

«RITE< 16.90 1 i > I ALT l , IALT2, IALT3, I ALT 4 > I ALTS 
9011 FORMAT 1 2 1 1 * ”3S" * IX, 311) 

ENOLIST 
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labelcdme > 
zsetco ,r> 

MOVE< -C .34F--0 . 0M34D 
ttiRITEf 16,5 55>DIST 
ENDUST 

XFEET=XM*608Q . 2 

EPS = ATAN<<Y + 30G2«35)''< (XM+31 .0816? *6080 ,2)) 

HER=A-XFEET*C-0 ,052933? 

BTETA=8PHI»BXI=0 . 

CALL SAMPLE 
BTETA=CTETA+2 . 1 
BPH I =CPH I 
BXI “CX I 
CALL RTQF 
C 

C*** START THE DISPLAY 
C 

A JPSR 4GRAFX 

A 4DIAL3 

A 5 

C 

C*** INITIALIZE DATA-UPDATE CLOCK 
C 

2 I T I ME- 1 
C 

C*** ENTER WAIT LOOP IF SWITCH 3 <9T ART? IS NOT ON 
C 

IF ( . NOT. SWITCH (3? > G 0 TO 2 
C 

C m + + # EXECUTE UNLESS SWITCH 12 (FREEZE? IS ON 
C 

6 I F ( I OTXX-CT I M ? 85 1 j 85 2 j 852 
852 0PEN<2 1 * 0 ; 2« 3 1 BUFF , 1 VALUE 1 1 > 

C 

C* ** STORES RECORDED NOMINAL VALUES IN DATA AND ATEXT FILES 
C 

WRITE* 21 )L0C1 , CULK I > / UMlK I ) - QQ< I > # TEET < I ? , HH < 1 ? > RANGE ( I >, THU ? 
tTP< I>, EE< I>,TGTT< I > , 1=1 , LOCI ? 

CLOSE (21) 

0PEN(2D>ij J 2,8!BUFF, ' AT EXT 1 1 - J 

llJR I TE < 20 , 20 20 ?LOC I / ( UU C O , m C I > , QGK I ) , TEET (P.HHd), RANGE ( I > , 
ITH<I) ^ TP< 1 > ,EE< I) , TOT TCI ? ,1=1, LOCI > 

20 20 FORMAT (IX, 1 4 1 70 ( 1 X, F6 , 1 , F5 . 1 , F8 « 4 , F3 . 4 , F7 . 0 , F7 . 2 , FS , 1 , F7 . 3 

1F8< 3, FQ. Z * />> 

CLOSE < 20 > 
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c 

O** STORE RECORDED PATH VALUES IN DATA AND ATEXT FILES 
C 

GP E N < 2 l , 0 . 2i SlBUFF-r 1 PATH 1 1 :> 

WRITE* 21 >L0C2, <XX C I > , Y Y< I > , HHH< I ) , 1=1 ,L0C2^ 

CLOSE < 21 > 

OPEN* 20 ,0,2, el BUFF, ' ATEXT2 J > 

WRITE <20 , 2121 )L0C2, < XX < I > # YY < I > ,HHH* I > * l=l,LOC2> 

2121 FORMATCIX, 14 , ✓ , 70 < IX, 2F 12 . 2, F 10 .0, '>> 

CLOSE < 20 
LOC 1 =0 
LOC2=0 

CT I M=CT I M*2 1 0 . 

I T I ME = 1 
851 CONTINUE 
C 

o** AFTER SWITCH 3 HAS BEEN PRESSED, PRESENTLY RECORDED NOMINAL 
C*** VALUES AND PATH VALUES ARE STORED 
C 

IF<SWiTCH<3))G0 TO S52 
IF< ,N0T.SWITCH<12)>G0 TO 3 

C 

C*** AFTER SWITCH 12 HAS BEEN PRESSED, EXIT IF SWITCH lb IS ON.. 
C 

? IF *SWlTCH<16>)GO TO 4 
C 

C*** OR INITIALIZE VALUES IF SWITCH 4 <IC> IS ON... 

0 

IF *SWITCH*4>)G0 TO 5 
C 

C*** OR START EXECUTION AGAIN IF SWITCH 8 IS ON... 

C 

IF < SW I TCH 1 8 } > GO TO 6 
C 

C*** OR INITIALIZE DATA-UPDATE CLOCK AND ENTER A WAITING LOOP 
C 

ITIME=1 
GO TO 7 
5 CONTINUE 
C 

C*** STOP THE DISPLAY AND GO BACK TO INITIAL VALUES 
C 

A JPSR $NHALT 
A NOOP 

GO TO 1 
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c 

C + * + START EXECUTION OF A NEW DATA-UPDATE CYCLE: 

C + + * COMPUTE DT C=TIME IN 'SECS OF PREVIOUS CYCLE > 

C + + * AND INITIALIZE DATA-UF'BATE CLOCK 
C 

3 T I ME- 1 T I ME 
I T I ME=0 
DT -T I ME^l 20 . 

CALL DYNNF 
XFEET-.XM+60 80 . 2 
I F < XFEET . EQ . 0 . )XFE ET=1 . 

YI1ILE=Y.'603fl .2 
HER= A -XFEET + T NG-SA 
irCXM.EQ.-3l . 08£6>XM*-31 .082? 

ERS=rtTANCCYMILE+ . 50 366 > / < 3 1 . 0 326+XM) > 

I F<XM . rr « . -5 . 4396) XM=-5 . 4395 
C 

C++* VOR / ADF AND DME INFORMATION 
C 

ADF = 35 . -ATANCYMILE/-C-XM-5 . 4396) )*RAD 
IFCXM.GT . -5. 4 396 >ADF=ADF+ 130 , 

IFCXM.EQ.-3i .08£6>XM=-3i .0316 

V0R=35 . -ATANC t + YM I LE + . 50 366 > / ( -3 1 . 0 826 -XM > ) + RAD 
I F CXM . GT . -3 1 . 0 826 >VOR=VOR+ 180 . 

ADF=AMODCADFj 360 . > 

VORsAMODCVORj. 360 , ) 

CALL RTOF 

DIST = $QRTC CXM + 31 . 0 826 > +*2+< YM I LE+ . 50366)**2) 
LABEL < DME > 

ZSET < 0 . OF; 

MQVEC-0 . 34F, -0 . 0 1434F) 

WRITE C16j 555)DIST 
555 FORMAT < " 93% F5 . i ) 

ENDLIST 
RALT-A/10000 , 

I ALT I =RALT 

RALT -10 , +«:RALT-I ALT1 > 

IALT2-RALT 

R A L T = 1 0 . +( PALT- IALT2> 

I ALT3=RALT 

RALT = I 0 . + c RALT- I ALT3) 

I ALT4-RALT 

RALT- 1 0 . +CRALT- I ALT4 > 

I ALT5-RALT 
LABELS ALT ) 

ZSET C 0 .OF) 

MOVE < .61 F, . 39F ) 

U)R 1 TEC 16. 30 1 2/ I ALT 1 . I ALT 2. I ALTS > I ALT 4 , I ALT 5 
90 12 FORMAT (.211 . "-53" » t X ^ 3 I t ) 

ENDLIST 






x i 


c 

c * * * 

c 

c 

c**+ 

c 

c 

c+*« 

c 


c 

c*** 

c 


c 

c*++ 

c 

A 


c 

c 


2000 

2001 


2002 

2003 


CONE=« , F ALSE . 

IOM° IMM= I IM“0 

IF^EPS.LE.O ,0 5. AND . EIPS , GT . -0 , 0 5 ) CONE* , TRUE , 

TURN OUTER MARKER LIGHT ON 

IF CABSCXH + 5. 4 89b> . LE . TMRKR1 . AND . CONE > I OM« 1 
TURN MIDDLE MARKER LIGHT ON 
I F < ABS < XM+O . 7096 > . LE , TMRKR2 . AND . CONE > IMM= 1 
TURN INNER MARKER LIGHT ON 

IF < AB$^XM + 0 , 1896) . LE . TMRKR . AND , CONE MIM-l 
CALL BEACONSdOM, IMM, I I M , JJFF) 

EXIT IF ALII TUDE^O 

IF<A>4, 4,6 
CONTINUE 

STOP THE DISPLAY, TURN ALL LIGHTS OFF 

JPSR 4NHALT 
XFF*XM*GO0O . 2+1153. 

KDT = 1 . /DT 

SHOW PARAMETERS AT TERMINAL TIME OR AT STOPACTION ON CRT SCREEN 


WR I TE < 25 ,20 00) 

WRITE <25, 20 0 1 > TOTXX , R I AS , X I 
MR I TE < 25 , 20 0 2 ) V Z 


WRITE <25, 2003>UVEL, WVEL, G, THETA, A, 
FORMAT < /////2?X, " PARAMETERS AT TER 
FORMAT <27X, ''TOTAL FLIGHT TIME 

1 27X, "INDICATED AIRSPEED 

2 27X, "HEADING 
FORMAT < 27X , " VERTICAL SPEED 
FORMATS -'27X> "FORWARD VELOCITY U 

1 27X * " DOWNWARD VELOCITY W 

2 27X> "PITCH RATE 

4 27X, “PITCH ANGLE 

5 27X, "ALTITUDE 

6 27X, "RANGE 

727X * "THROTTLE POSITION M4X,F 

8" LBS. "»/*27X, "ELEVATOR POSITION 
EXIT 


DIST.TPOS, T,CTETA 
MINAL TIME OR AT 5T0PACT I ON " /.O 
,F15.0, " SEC. 'V 
M ,:3X,F7. 1, *' KNOTS 1 ' / 

" , tOX, F5 . 1, " DEG , " > 

" ,F15 . 1 , " FPM " ) 

” - 10X, F7 . 1 j 11 FT. ^SEC . ”/ 

", 1 OX , F7 . 1, " FT , /SEC . "/ 

" , 13X, F7 , 4, 11 RAD, /SEC. 11 / 

“ d 3X , F7 ♦ 4 * " DEG , 11 / 

" , 10X, F6 . 0 , " FT. ”/ 

M1X,F6, 1, 11 NAUT, M I . " / 

6.4, /,£?X, "THRUST" , 25X,F3 . t , 

11 , 1 3X j F5 . 2/ " DEG, M > 
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SUBROUTINE SAMPLE 
C 

C*** SUBROUTINE TO SAMPLE COCKPIT CONTROLS 

C 

GLOBAL SPBRK, FLAPS, THRUST 
IMPLICIT FRACTIONS) 

REAL FLAPS 

COMMON’-RELAX^SCORO, SSPAN, SAREA, P, 0, ROW, RMACH, DPP - DOG , DRR , SPALF 
COMMON^PRMTR^V, XI , BET AG , D T 

COMMQN^PRMTR.'' ALPHA , BETA , PH I , VX , VY , VZ, THETA , A , XM , V , R , R I AS 
COMMON/CNTRL/T, FLAPS , CTETA , CPH I ,CXI , GEAR , SPBRK, TPOS 
COMMON/CNTRL.'BTETA, BPHI , BXI 
A ADEPT 

FPRI 

MD07 1 F 0 

o;o ;o 

MDO 7 ’ F 10 

o ;o 

S5MD FSPBRK 
MDO 7 1 F 20 
o ; o 

S5MD FT1 
MDO 7 1 F 40 
OJO 

S5MD FT2 
MDO 7 1 F 100 

o;o 

S5MD FT 3 
MDO 7 1 F 200 

o ; o 

S5MD FT 4 
MDO 7 1 F 0 

o ; o ; o 

MDO 7 1 H Cl 

o;o ;o 

MD07*L; 1 ! H 1 

o ;o 

S5MD FFLAPS 
MD07'L; 1 ! H2 

o ;o 

S5MD FVOKE 
MD07'L; I!H4 

o ; o 

S5MD FWHEEL 
MD07'L; 1 ! H 1 0 

o ;o 

S5MD FPEDL 
MDO 7 ' H Cl 

ojo;o 

UPRI 



DOtfN: 


MASK x 
ZERO i 
ONE: 
FGEAR: 
FSPBRK: 
FT 1 : 

FT2 i 
FT3 i 
FT4r 
Cl s 

FFIAPS ! 
FYOKE! 
FbJHEEL * 
FPEDLi 
BACK t 


MDAR MASK 
S6AR ' A 1 F 
ARARAT 
JPLS DOWN 
MDAR ZERO 
ARMD FGEAR 
JUMP BACK 
MDAR ONE 
ARMD FGEAR 
JUMP BACK 
00 100 *HG 
(MHO 

0 !H3 777 ? 

0 

0 

0 

0 

0 

0 

0 1H00001 
0 
0 
0 
0 

NOOP 


HASKUP i 10000 
MASKDN 104000 

MDAR MASKUP 

S6AR * A ‘ F 
JPLS SUUP 
MDAR MASKDN 
S6AR' A'F 
JPLS SLUON 
JUMP SWEN 


SWUPf NOOR 
FORTRAN 

BTETA=BTETA+ .05 
A ADEPT 

JUMP SWEN 
SIDD N: NOOP 
FORTRAN 

BTETA=BTETA-<05 
A ADEPT 

SMEN: NOOP 
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FORTRAN 

C 

C*«* MACH NUMBER 
C 

IF<A-36089. >9004,9004, 9005 

9004 RMACH=V. '6*1 , -< 002434*A>> 

GO TO 9006 

9005 RMACH^V/573, 

9006 CONTINUE 
C 

C*** INDICATED AIRSPEED IN KNOTS 
C 

RlAS“<656.-< ,0091*A>>*RMACH 
SPBRK=FTGR ( FSFBRK ) +187.5 
IFCRlAS-189 , >9007, 9007,9003 
9008 SPMAX® 60 . - < . 233+ < R I AS- 1 83 . ) > 

SPBRK=AM I N 1 C SPBRK * SPMAX > 

9007 CONTINUE 

FLAPS® AMAX2< 0 . OF, FFLAPS* + 128 , 3 15 
IF < FLAPS-3PALF > 90 0 1,9002,9003 

900 1 FLAPS=SPALF-. 4175 
CO TO 9002 

9003 FLAP$=$PALF+ .4175 

9002 SPALF-FLAPS 

CTETA=C -FTOR CFYOKE > + 1 S . 75-6TETA) +2 . 0 
CPHl=C“FT0R(FUHEEL>+42. 5-BPH1/1 . 85>*1 . 85 
CX I = < F TOR t FPE DL > +20 . 5-BXI -'2 . 65) +2 . 65 
C 

c**+ THRUST COMPUTATIONS 
C 

THRUST=FT0RCFT1+FT2>+FTGR<FT3+FT4> 

TPOS* < THRUST- . 3727)^1 ,1761 
TPOS-AMAXUTPOS.O . > 

TP0$=AMIN1 (1.0, TPOS) 

IFCA-10000 . 5820# 821 ,321 

820 RMAXT= 1 330 0 . - . 28 1 25 + A + < .3117+A-7800 , ) +RMACH 
RIDLT=1000 . -2000 . +RMACH 

GO TO 822 

821 RMAXT= 13600 .-.28 125+ A 

1 + C * I2+( A- 1 0000 . >-3125- > * R M A 0 H 
R I DLT =10 0 0 . +< . 0 5 + < A- 1000 0 . >“20 0 0 . > +RMACH 

822 RI DLT=AMAX 1 ( R I DLT , 0 . > 

T=<RIDLT+CRMAXT-R I DLT>+TP03+TPOS>+4 . 

206 GEAR®FTOP CFGEAR > 

RETURN 

END 


SWSSSS 
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SUBROUTINE BEACONS< I OH'# IHM> IIW, JJFF) 

C 

C*** SUBROUTINE TO OPERATE MARKER-BEACONS' LIGHTS 
C 

IF < l OM , OR , I MM * OR , UH>9, 10 

9 CONTINUE 
JJFF=JJFF+l 

GO TO <8,8.6, 10 >> JJFF 
8 CONTINUE 

IF < IOM) 1 >4 
4 I F < I MM ) 2 * 5 

5 IF<IIN>3,6 
C 

C*** NONE OF THE LIGHTS SHOULD BE ON: 

C*** TURN THEM ALL OFF 
C 

10 J JFF =0 

6 COHTimE 

A ADEPT 

MDAR. BCN 
ARIC 1 A ' F 
JUMP .+2 

8CNi 77277 1 H57777 
NOOP 
FORTRAN 

CO TO 7 
t CONTINUE 

A MDAR OUTER 

A ARIC'O 

GO TO 7 

2 CONTINUE 

A MDAR MIDLE 

A ARIC'O 

GO TO 7 

3 CONTINUE 

A MDAR INNER 

A ARIC’O 

GO TO 7 
A ADEPT 

OUTER 1 20000 
MIDLE J 0 0 4GG ! H 
INNER tOO 100 .'H 
FORTRAN 

7 CONTINUE 
RETURN 
END 



[ 
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SUBROUTINE DYNNF 
C 

C DYNAM I CS-COMPUT I NC SUBROUTINE 
C 

GLOBAL DVZ,CT,MP, APR, DP, DQ,CR,P,Q, R 
GLOBAL CXI,CPHl ,CTETA, ALPHA, BETA 

GLOBAL UVEL , VVEL . WVEL < RVX , RVY , RVZ, UDOT , WDOT, VOOT , VTOT 
GLOBAL THETA, PHI , XI , L , D , SFQR 

GLOBAL LLL.MMM.NNN. RF I E , RTE T , RS Y , V , RX , RY , RZ 
REAL L, FLAPS, LLL,MMM,NNN 

COMMON /RELAX, 'SCCRG, SSP AN, SAREA, P , Q , ROW , RMACH , GPP , DQQ , DRR , SPALF 
COMMON/ WORK /UVEL , VVEL , WVEL ,VTGT,UCTT, VDTT, UIGTT, VTOD 
COMMON/EXTRA/ODFIE, OCTET , POSY , RF I E , RTET - RS Y , STTET , CTTET , SF I E , CF I £ 
COMMON/ MGR E/SSY , CS Y 

CGMMON/CNTRL/T , FLAPS ,CTETA,CPHI , CXI . GEAR. SPBRK, TPOS 
COMMCN/CNTRL/'BTETA, BFHI .BXI 
COMMON./PRMTR/-V, y,I , BETAG, OT 

COMMON/PRMTR /ALPHA , BETA , PH I , VX , VY , VZ , THETA , A , XM , V , R , R I AS 
COMMON/FD/ADE. VOR, EPS, HER.P.AD 

COMMON /GUT/UU (100 ) , W UK 100 > • Q®< 100), TEET <100 ) , HHUOO > , RANGE < 100 ) 
COMMONyOUTyTPC too) , EE < 1 GO ) , XX( 70 ) , YY< 70 > . HHH ( 70 > , TOTXX, LOCI , LCC2 , 
1T0TT< 100) , THf 100) , D I ST 
CALL SAMPLE 
V2=VT0T+VT0T 
C 

c**« ATMOSPHERIC DENSITY 
C 

R0W=,2378E-2+<A*aA/K 1 .S0 6E12) >-< .6S534E-7))) 

RLPAS=FLAPS-6 , 

RL APS=RLPAS-8 , 

RLPAA=AMAX1 (RuPAS, 0 , ) 

RLAPP=AMAX1 (FLAPS, 0 . ) 

RCFP=AMINl CRLPAA, 1.0) 

CLT=< <4 . 584+-RMACH+ (5 . 387+RMACH-2 , 22 ) + < 1 .081 )*RDFP>«K < WVEL/ VTOT) + 

1 . 0 331 ))-. 0055 *CTETA + RLPAA* ,01432 
C 

C*** LIFT 
C 

L=R0W*V2+SAREA*CLT 
IF (RMACH- . 345)81 1 ,811,212 
811 IF<RM«CH-. 3)813, 813, 814 
813 IF C RMACH- .7)815,315,316 

815 CDM= .012 
GO TO 818 

912 CGM=- , 10S9+ . 1455*RMACH 
RK=- . 64 1 1 ♦ . 83 3 3 ♦RMACH 
GO TO 819 

014 CGM=- . 0 1735<- .0371 *RMACH 
RK=- , 13603* . 2356*RMACH 
GO TO 819 

816 CDM«.0097*. 0033*RMACH 
818 RK= . 0524 

019 CONTINUE 
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C 

C*** DRAG 
C 

D"R06I*V2+SAREA* (CDN+RK*<CLT*CLT)+ . 0 1 03*GEAR+RLPAA* , 00 18* . 833E-3* 
1SPBRK) 

C 

C*** SIDE FORCE 
C 

SFOR’ROtd* 1 505 , *VTOT*C-. 91?*VVEL- ,004*VT0T*CXI) 

DF IE e P+ (SF IE^STTET^CTTET) *(3+<CF IE*STTET-'CTTET ) fR 
DTET=CFIE*<2-SriE*R 
OSY=<SFIE.-CTTET>*Q+CFIE*R*'CTTET 
RF IE-Rr I E+ (( 3, *DF I E-DDF IE) ♦DT/-2. ) 

RTET»RTET+(<3. *DTET-DDTET)*DT''2. ) 

RSY=RSY«-<<3.*DSYH>DSY)*DT,'2. > 

DDFIE=DF1E 

DDTET=DTET 

DDSY=>OSY 

C 

C*** EULER ANGLES 
C 

PHI=RFIE*RAD 
THETA=RTET*RAD 
XI=RSY+RAD 
STTET-S JN<RTET) 

CTTET=CQS<RTET> 

SFIE=SIN<RFIE> 

CFIE=C03CRFIE> 

SSYeSINCRSY) 

CSY=COS<RSY> 

C 

C*** ROLLING. PITCHING, AND YAWING MOMENTS 
C 

LLL=ROIU*VTOT*<VTOT+SSPAN*( • . 1 7 1 9*VVEL''VT0T + . 0 0 1 13*CPHI- . 00(T2*CXI ) 
l-< . 60 ?45E7*P ) ) 

MMM=R0W*VTQT+ < VTOT*SCORD* ( , 048-< . 955+WVEL,-VT0T) + . 009+CTETA+ 

1 RLAPP* < - . 0033) >-< . 12SE8*Q)) 

NNN=ROW*VTOT+< VTOT*SSPAN+< . tl 5*VVEL-'VT0T+ . 0 0 1 I*CXI )-( ,239?8E7*R>) 
DP=<(<LLL/.382E7>>-R+G*< . S56)+P*Q+< ,0974)) 

DQ=< C <MMM.' . 485E7) >+P*R*< , 336.) -< < P*P >-< R*R ) ) + < . 0 767) ) 

DR = < (. <NNN/ , 81 2E7) )-P*S*< . I27)-R*0*< , 0458) ) 

C 

C*** ANGULAR VELOCITIES IN BODY AXES 

P=P+<< 3,*DP-DPP)*DTV2, > 

Q*Q+('3>*0G-DQQ)*DTV2, > 

R»R+< ( 3 , *DR-DRR > ♦DT/'S , > 

DPP-DP 

DQD=DQ 
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C 

C*** AERODYNAMIC ANCLES 
C 

ALPHA*RAD*UIVEL,'VTOT 
BETA=RAD*VVEL/VT0T 
BETAG=8ET A 

BET 1 = 1 <VVEL+VVEL>/(2.*VT0T*VT0f>) 

CONI =- 1 / C 6937 » +VTOT) 

UD0T-<C0N1*CUVEL*BET1*D+<UVEL*VVEL^VT0T)*SF0R-UVEL*L) >- 
1 <Q*WVEL-R*VV£L>-32 . 2*STTET+T/6937 . 

VDOT=<CON1*'VVEL*D-VTOT*BET1 *SFOR> > - (fl*UVEL-P*UJVEL>+32 . 2*CTTET* 
1SFIE 

WDOT=(COtU*CWVEL*BETl*D+<lllVEL*VVEL/VTOT>*SFOR+UVEL*L>>-- 
1 CP*VVEL-Q*UVEL)’*32.2:>CTTET*CFIE 
VTOT*SQRTOJVEL*UVEL+VVEL*VVEL4-aVEL*WVEL5 
V^VTQY/1 . 69 
C 

C*** LINEAR VELOCITIES IN CODY AXES 
C 

UVEL=UVEL+<<3.*UDOT-UDTT3>*DT/2 . ) 

VVEL-VVEL+C < 3 * *VOOT— VP- T>*DT/2, > 

WVEL=Q)VEL+< <3 . *WDOT-ttfDTT ) *DT /Z , > 

UDTT=UDOT 
VDTT=VDOT 
WDTT -UJD0T 
C 

C*** LINEAR VELOCITIES IN VEHICLE AXES 
C 

RVX*CTTET*CSY*i/VEL+<SFIE*STTET*CSY-CFIE*S5Y)*VVEL+<SFlE*SSY+ 
1CFXE+CSY*STTET,- ^WVEL 

RVY^CTTET*S3Y*UVEL+(CFIE*CSY + SFIE*STTET*SSY>*VVEL + CCFIE*STTET’i'SSY 
1-SFIE*CSY>*U!VEL 

RVZ=-STTET*UVEL+SF1E*CTTET*VVEL + CFIE*CTTET*UIVEL 
VZ--60 . *RVZ 

VX = .5735*RVY+ . 31915*RVX 
VY- , 8191 5*RVY- . 5735*RVX 
C 

C*** EARTH COORDINATE SYSTEM POINTS 
C 

XM = XM+ < VX.-'bO SO , 2 > *DT 
Y=*Y + VY*DT 
A^A^VZ+DT/60 . 

X I “AMQD < X I * 360 . > 

PH1=AMODCPHI,360 . ) 

THETA=AMOD< THETA, 360 , > 

A^AMAXl ( A. 0 . > 


OE POOR ® JAUU 



C*** RECORD NOMINAL VALUES OF STATES AND CONTROLS EVERY 3 SECONDS 
C*** RECORD EARTH POSITION VALUES EVERY 5 SECONDS 
C 

TOTXX=TOTXX+DT 

T1NT*3. 

IF<AWOD<TOTXX< TINT) , GT ,DT)GO TO 101 

L0C1=L0C1+1 

UU < LOC 1 > =UVEL 

UWl<LOCn=lDVEL 

QQCLOCl >=Q 

TEET<LOCn=RTET 

hh:loci )=a 

RANGE < LOCI )=DIST 

TH<LOCl)aT 

TP<LOCn=TPOS 

EE<L0C1>=CTETA 

T0TT<L0C1)=T0TXX 

101 CONTINUE 
TINT=5. 

IF <AMOD<TOTXX< TINT) , GT . DT)GO TO 102 

L0C2=LQC2+ 1 

XX<LOC2)=XM*60 80 ,2 

YY <L0C2)=Y 

HHH < L0C2 > =A 

102 CONTINUE 
RETURN 
END 
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c 

c**+ SUBROUTINE TO CONVERT DATA REAL-TQ-FRACTION 
C 

GLOBAL TRIG, FPICH1 , FPCH1 
IMPLICIT FRACTION <F> 

COMMON^FRMTR^V, XI, BETAS, DT 

COMMON ''PPMTR.'ALFH A, BET A , PH I , VX , V Y , V2 , THETA , A , XM , V , R , R I AS 
COMMON 'FRAC'FV. FBNK,FPICH,FA, F VZ , FHDG , F ADF , FVOR , FCP 1 CH 
COMMON/FRAC/FER, FHER , DUE < 6 > , ALT C 7 > 

COMMON'FD/ADF, VOR-EPS, HER, RAD 
F V- (20 0 ,-AMOIXRIAS, 40 0 . > >.^20 0 . 

FBNKl=PHI/360 . 

FBNK-FBNK 1 +FBNK 1 
FP ICH I =-THETA/‘360 , 

FP I CH=FP I CH 1 +FP I CHI 
I F < A , LT . C . > A = Q . 

FA“ < 50 0 . -AMGD < A , 100 0 , >)^50 0 . 

FVZ*-FMIN1< 1 . , A MAXI CVZ/^OOO , , -1 . ) > 
FHDG1=AMOD<<XI-BETAG>,360 . >>'360 . 

FHDG=FHDG1+FHDG1 
FADFl--ADF/'360 , 

FADF=FADF1+FADF 1 
FVORt=-VOR^360 . 

FVOR-FVOR 1 +FVGR 1 
ERR=EPS*RAD“18 .07 
TEMPP-AMAXl <£RR, -5 . 0 > 

ERR=AM IN K5.0 , TEMPP > 

FER=ERR*0 * 12 
1 F< XM . EQ . 0 . > X M = 0 .00 0 1 
AHER*HER*RADXXM*60S0 . 2> 

TEMPP=AMAX 1 CAHER, -0 . 7> 

TEMP-AMI Nt CO . 7 , TEMPP> 

FHER=TEMP*Q .22857 

RETURN 

END 



IMAGE DIALS 


168 


c 

o** SUBROUTINE TO DISPLAY THE INSTRUMENT PANEL 
C 

integer iftimx 

IMPLICIT FRACTIONS 

COMMON- TRAC/FV, FBNK , Fp I CH , FA , FVZ > FHDG , F Gt>F , f VOR, FCP1 CH 
COMMGN/TRhC^FER, FHER -DME<6:- , ALT<?> 

LINKAGE PTR< 3 ) * LYME C 4 } , FNTR <. 20 ) 

LINKAGE G S T C 3 j . LO C K 5 > . AO FN C i 3 > . VORN C l 0 > , HDN G C 5 > 

C. 

C** + AO 0 FTIMX TO I TIME- TO UPDATE THE DAT fi-UPOATE CLOCK 
C 

i I T I ME = i I T I ME + TFT I MX 

POSCHARCO .2417F.-0 . Q1434F,-0 , 3F , 11 SS53 H ) 

POSCH ARC Pt-1E > 
p OSCH AR < ALT > 

L D Y < 0 , F } 

TABLE2D < HDNG } 

LDXC-0 - 75F > 

LDY CO , 4 9F> 

LSCLCQ .2?5F> 

LRZCFVj 

TrBLEZDCPNTR) 

LDXCO . 71F) 

LDY < 0 . 52F> 

LSCLCO . 2SF ) 

LR2CFA) 

TABLE2DCPNTR) 

LDXCO ,71826F> 

LDY < -0 .20575FJ 
LSCLCQ .2S5F> 

LRZCFVZ-Q , 5F> 

T ABLE2D ( PNTR > 

LDX < 0 . F) 

LDYOO .323F) 

LSCLCO . S3F> 

LRZ < FHDG > 

T ABLE2D C % CCttRD ) 

ROTZi-O ■ 10 0 33 SF ) 

A 2DT BUG 

ROTZOO . 1 9444F > 

DX CFER ) 

T ABLE2DCLYNE) 

LRZCFHDG) 

LDXC-0 . 745F) 

LDYC-Q , 212F> 

LSCLCO . 275F > 

ROTZCF ADF> 

T ABLE2D ( ADFN J 
ROTZCFVOR-FADF) 

TABLE2D < VORN j 
LRZ< FHDG> 

TABLE2DC *CC ARO> 

LDX CO . F ) 



LDYCO . 66F ) 

LSCL < 0 . 32F) 

LRZ< F6NK ) 

TABLE2DC PTR) 

LSCL C l .OF) 

ROTXCFPICH) 

LAK16B, 1 .OF) 

LAK17B,0.5F) 

TABLE3DC*HP20N> 

RETURN 

DATA2D CLYNE ) 

ZSETCO .OF) 

LINE<0 . F, 0 .43F,0 , F , -0 . 5286F) 

ENOLIST 

ENDDATA 

data2D-:pntr) 

ZSETCG .OF) 

MOVE r 0 . OF, -0 . 5 F) 

ORAUK-O . 0 2 F , - 0 -56F) 

ORAUK-Q „ 0 2F * “0 .74F) 

DRAWCQ . 0 F * -0 . 3F ) 

DRAW C 0 . 02F, -0 . 74F ) 

DRAW C 0 . 02F, -0 . 56 F> 

DRAW C 0 . OF, -0 . 5F j 
DR AW C 0 . OF * - 0 . 26F > 

DRAW < 0 . G4F, “0 . 2F ) 

DRAWCO . 04F, 0 .OF? 

DRAW C 0 . 06F, 0 . IF) 

DRAW C -0 * 0 6 F , 0 . IF) 

DRAW C -0 . 04F, 0 .OF) 

DR AUK -0 . 04F, -0 ,2F) 

DRAW C 0 . OF,-0 . 26F) 

MOVE CO . 0 F > 0 .OF) 

DRAWCQ . 0 F , 0 . 0 F > 

ENDLI3T 
ENDDATA 
DATA2D *: SS I > 

ZSETCO .OF) 

MOVE C -0 . 3F, 0 . 55F) 

DRAIiK-0 . 36F,0 . 59F) 

DRAWC-0 . -3F , 0 . b3F ) 

MOVEC-O .3F#-0 . 30 F> 

DRAW C “Ci * 36F, -0 . 34FX 
DRAW < -0 . 3 F , -0 . 33 F) 

ENOLIST 
ENDDATA 
DATA2DCL0CI > 

Z5ET CO -OF) 

MQVEOQ . 0 4 F , 0 . 16F> 

DRAW C 0 . OF, 0 . 12F) 

DRAWCO . 0 4 F , 0 . 16F) 

ENOLIST 

ENDDATA 

DATA2DCADFN) 

ZSETCG . OF) 
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MOVEC-O . IF * 0 , 5F > 

DRAUK-0 . lF,-0 . 7F > 

DRAUKO .OF f “0 . SF ) 

DRAWCO . IF / “0 .?F> 

DRAW C 0 . IF ,0 . 5F) 

DRAUK-0 l4FrO,5F> 

DRAW < 0 . OF * 0 . @F ) 

DRAW < 0 . 14F,Q ,5F) 

DRAUKO . IF,0 .5F> 

MOVEOD . OF,0 . -?F} 

DR AW < 0 . 0 F > 0 .SF> 

MQVECG .OF , 0 .OF) 

DRAW C 0 . OF/O . OF) 

MOVE C 0 . OF, -0 . 8 F ) 

DR AW C 0 .OF, -0 . 9F) 

ENDLIST 
ENDDATA 
DAT A20< VORN) 

ZSET < 0 . OF) 

M 0 V E < 0 . 0 F . 0 . 3 F > 

DRhW< - 0 . 0 4 F rO ,6F) 

ORAUK-O .<MF, -0 .SF) 

DRAUKO . If 4F , -0 .SF) 

DRAUK 0 ♦ 0 4F , 0 .6 F > 

DRAW CO « OF, 0 ,SF) 

MOVECO . OF * 0 . 3 F ) 

DRAUKO . OF, -0 . 9F> 

ENDLlST 
EHDDATA 
A ADEPT 

BUG: 0 

1631224426; 1631221261 ; 1314423345; 16312244 
20 0 0 02674-3; 1 14621 1 662; 1 146215461 106314144 
0767613244; 1 1462 l 5461 ; 663 14623 1 6 ; 63 1 4655465 
60000 130 54 : 60000 13055; 60000 13055; 7000005462 
7000005463; 7000005463 : 1000072314; 1000072315 
10 0 0 0 723 15 ; 500 u 0640 22 ; 20 00 064023; 1 7777640 23 
FORTRAN 

DATA2D <PTR ) 

2SETC0 . F > 

MOVE C 0 . F - 0 . 833 *F ) 

DRAW C -0 . 15F , 0 . 6667F) 

DRAW C 0 . 15F , 0 .6667F) 

DRAW CO . OF , 0 . 8333F > 

ENDLlST 
ENDDATA 
DATA2D CHONG > 

ZSETCu . OF) 

MOVEC-O * 0 1 5F * 0 . 03625F > 

DRAW C 0 .F.O , 0025F; 

DRAUKO . 0 1 5F i 0 .03625F) 

ENDLlST 

EMDDATA 

RETURN 

FNO 
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PROGRAM AS 


C 

O** THIS PROGRAM COMPUTES THE LINEARIZED EQUATIONS WHICH DESCRIBE THE 
C*** CONTINUOUS-TIME A AND e MATRICES EVERY 3 SECONDS 
C 

C*** THE PROGRAM USES THE DATA FILES CONTAINING THE NOMINAL STATE 
C*** AND CONTROL VALUES PRODUCED BY "NV" AS INPUT 

C*** THE COMPUTED A AND 6 MATRICES ARE STORED IN DATA AND ATEXT FILES 
C 

REAL L 

DIMENSION I BUFF <20 8 > ,UU< 100 > - UtUI C 1 0(0 , OQ < 10 0 > , TEETdOO ) , HH <100), 

1 RANGE < 100 ) , TH< 100 > > TP< 1 0 0 > , EEC 100 ) , TOTT< 100 >, A<10 0 , 6, 6), 

2B< 100/6.. 2) 

WRITEC 10 , 1 0 0 > 

100 PORMAT < IX.- "ENTER 2-DIGIT NUMBER OF VALUE FILES IN OCTAL". /> 
READOO, 10 1) NUM 

101 FORMAT (02) 

DO 4 J = 1 » NUM 

0PENC21 , 0 , 2, 3 I BUFF , ' VALUE 1 ' ) 

REWIND 21 
IF< J~1 )2, 3, 2 

2 DO 3 K=2 i J 
SKIPFILE 21 

3 CONTINUE 

READ<21 )L0C1 , CUU< I ) , lUtlK I > , QQ ( I ) , TEETC 1 RANGE < I ) , TH < I ) , 

1TP<! > , EEC l > » TOTT Cl) • 1 = 1, LOCI) 

CLOSE<21 ) 

DO 102 KL= 1,50 
102 CONTINUE 

DO 1 1=1, LOCI 
UVEt_«UU< I ) 

U) V E L = U> 10 < I ) 

Q=QQ C I ) 

THETA=TEET < I ) 

AA=HH C I ) 

RANG=RANGE< I > 

THRUST = TH', I) 

TPOS=TP ( I ) 

CTETA = EE< J > 

VTOT = 3QRTCUVEL + UVEL-*-WVEL + iDVEL) 

V2=VT0T*VT0T 

ROUI= , 2373E-2-KAA+CC Afi^C 1 . 8Q6E12) )-< .6C584E-?) ) > 

RMACf sMTOT^C 1 .69* <66 l . - < . 002434*AA) > ) 

CLMM=<4. 584+RMACH*<5 . 387+RMACH-2 , 22) > 

CLT=CLMM*< <U)VEL^VTOT+ . 0331 ) >- . 3055 + CTETA 
L=R0Ll*V2* 1 50S . +CLT 
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IF <RMACH- .8 45 >811. 811)812 

811 IF CRMACH- ,8)813) 813. 814 

813 IFCRMACH-. 7>S15. 815. 816 

813 CDM= , 0 ! 2 
GO TO 818 

812 CDM=- . I089+, 1455 + RMACH 
RK=- .641 1+ , 8333+RM ACH 
GO TO 319 

814 COH=-. 0 1 735+. 037 1 +RMACH 
RK = - . 13608+ . 2356+RMhCH 
GO TO 319 

816 CPM= , 0097+ .0033+RMACH 

818 RK= . 0 524 

819 CONTINUE 

CDCD=< <UJVEL/VTOT) + . 0 331 > + < CIO . 774^< 1 . 69* <661 . - . 0 0 2434 + AA > > >-2.22x 
1VT0T>'<1 . 69+ ( 66 1 . 002434+AA) > 

D=R0W*V2+ 150 5.+ CCPM+RK+ <CLT+CLT)> 

DDPU“2.+UVEL+D-'V2 
DD£>W=2 . +HIVEL+D/-V2 

[>LOU = 1505. +R0iJl + <- . 0 0 S5 + CTETA + 2 . +UVEL+ (CLMM+UVEL* < . 0662+ < WVEL/'Vl OT 
1 > >)+V2*UVEL*CDCD> 

DLDUJ=1 50 5 . +ROUI+C- , 0 0 55+CTETA+2 . + UIVEL + < CL MM* < VTOT+UIVEL+ < . 0 662+ < 
lttfVEL'VTOT) ) >>+V2*WV£L+CDCD> 

DRDH= . 002378+<<2,*AA^65536>-1 . 835>'6S536 . 

OCLOH= 1505 . +P0W+V2+< . 0 0 2434> + < . 0 33 I + < W VEL^VTOT ) ) + < < < 1 0 . 774*V2>7< 
11 . 69* < 66 1 .-.002434*AA>)>-2.22*VTOT>^<1 .69*<661 . - ■ 002434+-A6>*<66 1 . 
2- . O 0 2434*AA> > 

DTTD=<<-2000.+,05*< AA-10000 . ))+<! . -TP03+TP0S > + < -3 1 25 . + . 12+<hA- 
1 10000 . ) >*TPOS*TPOS)^< 1 . 69* VTOT+ < 66 1 .-.00 2434* AA) > 

0T0U=4 . +UVEL+DTTD 
DTDtU = 4 . +UIVEL+DTTD 

DTDH = 4 . * < VTOT + ( 1 . -TPOS + TPOS > + C . 0 5+ < < . 00 2434 > * < -20 0 0 . ♦ . 05+ < AA- 1 0 0 0 
10 . >))'<661 . - .002434*hA> > )✓ ( 1 . 6 9* <661 . - . 0 0 2434 *Ah > ) + < - , 2S125+VT0T*< 
2. 12+C f . 00 2434* < -3125 . +- , 1 2 + < A A- 1 0 0 00 , > > /< 66 1 . - , 0 0 2434* A A > > > >.'< 1 . 69 
3*< 66 1 , - . 0 0 2434 + AA ) ) > +TP03 + TP0S ) 

RNMM=V2*< 1505. >*<22 . 69) + < .043-. 955*WVEL'VT0T+ . 0 0 9 + CTETA > +752 . 5 + 
1516 . 84»VT0T*<-32 . 7>+G 
Ri = < 1505. ; +R0M+22 , 69 + < . 048+ . 0 0 9 + CTETA > 

R2 = 752 . 5+R0W+ 516 ,34*<-32.7> 

DMDU=2 . + UVEL + P 1 + <UVEL+ ; IHVEL)'VT0T > + <- . 955 ) + R2 + Q + UVEL/VT0T 
DMDW=2 . *iUVEL+Rl + <VTOT + UJVEL*WVEL''VTOT> + <- . 955 > +R2+Q*WVEL^VT0T 
D«OO=VT0T+R2 
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At I , 1 , 1 >=tD*C C (UVEL‘* , UVEL^V2>-1 . WTOT > -L* < UIVEL*UVEL'‘ < V2* VTOT) ) 
1 - < UVEL^VTOT )+DDDU+CUIVEL''VT0T> *0LDU + DTl>U^'69SS . 

At I , 1 < 2) = <D*CUVEL + ii(VEL/<V2*VT0T)>-t < < UIVEL*WVEL.-'V2 > - l . )/'/TOT)*L 
»-(UVEL''VTOTV+DDDUI + tWVEL/VTOT)*DLOW + DTDIli>-'6983 .-0 
At I , 1 ,3!>=-WVEL 
Atlj t < 4 ) =-32 . 2 *COS ( THET A) 

At I / 1 .. 5) = C t-tUVEL/VTOT) *D/ROUi + C WVEL^ C VTOT-ROUO >*I_>*DRDH 
l+DTCH-KHI'/EL/VT0TV*0CL0H>-''6?38. 

At I , 1 , 6)=0 , 


At I , 2 - l) = t <UVEL*WVEl.'CV2*VTrm )*£>■<-< C OJVEL*UVEL''V2>-l . >^VTOT>*L 
l-<WVEL/VT0T>+D!>PU-<lJVEL-'VT0T>*[)l{>li:>/6988 . +0 

A<I-2.2>=fCt C(DVEL*li)VEL/V2>-t . ) / VTOT ) *D + < U VEL*W VEL.' t V2* VTOT > > *L 
t-(WVEL-'VTOT>fDDDlll-<UVEL^VTOT> +OLDU) >/6988 . 

At I » 2 < 3 ) =UVEL 

At I ,Z, 4>=-32.2*SINCTHETA> 

At I , 2j 5> = t ( “till VEL /VTOT >*C>^ROld-tUVEL-' VTOT J +L-'ROUI )*DRDH 
1 -< UVEL/VTOT ) +DCLDH ) /'6988 . 

Atl,2,6>=0 . 


A<I,3, 1 >=DMDU' , 435E7 
At I < 3 - 2 )=DMDW/ . 435E7 
At I ; 3, 3>=DHD0-' . 485E7 
At I < 3* 4>=0 , 

AC 1 , 3< 5) = <RHMM^'t . 485E7 ) ) + DRDH 
At I j 3 , 6 > =0 . 


A<I,4, 1)=0 . 
AC 1 , 4 * 2>=0 . 
Atr,4 i 3)=l , 
At I , 4 , 4 >= 0 . 
At I , 4 , 5 )= 0 . 
At 1 . 4, 6>=0 . 


At 1 1 5 . 1 >=SINCTHETA> 
Atli5i2>=-C03t THETA) 
AC I » 5 > 3 ) e 0 . 


At 1 , 5,4 >=UVEL*COS C THETA>+UIVEL+S INt THETA) 
At I < 5/ 5>=0 . 

At I , 5, 6>=0 . 


AC t .b. i >=-COS<THETA> 

At I,6,2>=-$IN<THETA> 

Atl,6,3)=0 . 

AC 1 , 6 » 4 ) =3INt THETA) =*UVEL-CO St THETA) *U) VEL 
At I , 6; 5>=0 . 


At I j 6 j 6 > =0 . 


oeigwai; f age s 

OF K»R QBAlOT 



ec 1 * 1 * 1 ) = 1 . /69S8. 

B<I,2, 1 > = 0 . 

BU»3,I)=0. 

B < I / 4 , 1)=0 , 

SCI, 5, n=o . 

b<i,6#i>*q. 

B(M , 2^UIVEL+15Q5. +R0W+VTOT* < - . 0055>/6988 . 

BC I , 2, 2>=-UVEL*l505 . + ROW + o t o 0 55 > ♦VTQT/6988 . 

B < 1 , 3 , 2 ) -V2+RCW+1 50 5 . +22 . 69+ , 0 Cr $s . 435E7 
BC I ,4, 2>=0 . 

B< I / 5 , 2 ) ~0 . 

B(Ip6,2)=0 . 

1 CONTINUE 
C 

C++* THE A AND B MATRICES ARE STORED IN DATA AND ATEXT TILES 
C 

OPEN C 2 1 , 0 , 2, 3 I Burr , ■ A-MATR I X 1 ? 

WRITEC21 )LOCI p << <ACJl , J2, J3> - J3=l / 6> * J2 = 1 , 6 ) , J 1 = 1 , LOCI > 

CLOSE (21) 

0PENC21 >0 ,2,3lBUFF, ’B-MftTRIX 1 ) 

1DRITEC21 )LOC 1 * CCCBCK1 > K2^K3? > K3=l j 2 ) , K2- 1 , 6 > , K 1 = l > LOCI ) 

CLOSE < £ 1 > 

OPEN (20 ,0,1, 3 1 BUFF, ’ A -ATE XT 1 > 

WRITE <20 , 20 20 >L0C l , CTOTTC J 1 > , < C A < J 1 , J2 , J3 ) , J3-1 * 6) , J2=l , 6 > , 
1J1 — 1/LOC1 > 

2020 FORMAT < IX, I 4 , ^ , 1 20 C 1 X , F8 . 2 ,ss , 1 X . 6F 1 2 . 5 , ^ , 5 C 1 X , 6F 1 2 . 5 , ✓ 0 , ss > 
CLOSEC 20 ) 

OPEN <20 , 0 > 1 ,31 BUFF, ' B- ATEXT ( > 

WRITE <20 , 2120 LOCI , < TQTTCK I > , < C B < K 1 , K2 , K3 > , K3*l , 2 > , K2= 1 , 6 ) , 
1K1=1 , LOCI > 

2121 FORMAT t 1 X , I 4 , ✓/ , 120 U X , F3 . 2 , 1 2X , 2F 1 2 , 5, ✓ 5 (2 1 X, 2F1 2 . 5 , /v> J 

CLOSE < 20 j 
4 CONTINUE 
EXIT 
END 
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PROGRAM FGH 

c 

£>** THIS PROGRAM COMPUTES THE DISCRETE-TIME LINEAR SYSTEM F , G . AND H 
C*** MATRICES USING THE DATA FILES CONTAINING THE A AND B MATRICES AS 
c*** input; THE DISCRETE-TIME linear system matrices are stored 
C**>* ON DATA AND ATEXT FILES 

c 

DIMENSION GG(31,6,2),FF<3l. ) <S,6>,HH<31,6,2> 

DIMENSION AA(73, 6, 6) , BB(73, S,2> .• A<6, 6) , U(6- 6) > DC 6, 2) , 

1X<6, 6) , Y<6.6> ■ Z(6, 6) , EAOS, 6> , I BUFF (20 8) , PE ( 6, 6 > 

COMMON/MAI N1 -'NO IM, DUM 1 <6* 6> 

COMMON-'INOU-'KIN, KOUT 
NDIM=6 
KIN=10 
KOUT*lO 
DO 200 Jl=l , 6 
DO 200 J2 = 1 , 2 
200 D(J1, J2)=0 , 

D ( 5 , 1)=-1 . 

DC6,2)=-I . 
tURITEUO , 100 > 

100 FORMAT( IX, "ENTER 2-DIGIT NUMBER OF A-B MATRIX PAIR FILES",-') 

READ (10 ,10 1 > NUM 

101 F0RMAT(02) 

FLAG=0 . 

DO 1 1=1 , NUM 

LOC3=0 

KK = 0 

n=i + r-i 

0PEN(2I , 0 , 2, a I BUFF , 1 A-MATR 1 X 1 ) 

REWIND 21 
IF < I - 1 ) 3 , 2 , 3 

3 DO 4 J = 2, I I 

4 SKIPFILE 21 
2 CONTINUE 

READ(21 >L0C1 , <<(AA(J1 , J2, J3) , J3 = 1 ,6), J2=t ,6) , Jl=l ,L0C1 > 

CLOSE (.1 1 ) 

OPEN (21-0-2, OlBUFF, ’ B-MATRIX 1 ) 

REWIND 21 
DO 5 J = 1 , 1 I 

5 SKIPFILE 21 

READ<2 1 )L0C1 , ( < ( BB ( K 1 - K2 , K3 ) , K3 = 1 , 2 > , K2=l ,6) , Kl = l , LOCI ) 

CLOSE (21) 
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N*6 
1 = 3,0 
NR=6 
Nf*6 
MT^O 
N 1 =6 
N2 = 6 

DO 6 K- 1 i LOCI 
KK=KK+1 
DO 3 LM , 6 
DO 3 LL=1 , 6 

8 A<L,LL>=AA<K,L,LL) 

CALL MEXPv'N > A , T * EA) 

DO 44 J 1 ^ 1 v 6 
DO 44 J2= 1 , 6 
IT<Jt-J2)45/ 43,45 

43 XCJ1,J2>=1. 

RE<J1, J2>=3, 

GO TO 44 

45 XCJi , J2>=tt . 

R£< J 1 j J2 5=Q * 

44 A C J 1 , J2>=AACK, J1 , J2) 

COEF =3 . 

DO 46 KL=2, 19 
FL=KL 

COEF = COEF + 3 . /FL 
N3=6 

DO 48 J 1=1,6 
DO 48 J2=l,6 
48 Y< J1 , J2 ) =A < J 1 , J2> 

CALL MMUL<X,Y,Nl ,N2,N3,2> 

DO 16 JIM , 6 
DO 16 J2= 1 , 6 

RECJl , J2.)=RE<J1 , J2> + CZ( Jl, J2>*C0EF) 

16 X< Jl, J 2 > = 2 ( J 1 , J2> 

46 CONTINUE 

DO 17 JIM > 6 
DO 17 K 1M > 2 

17 YCJl.KD-BEKK, Jl.Kl ) 

DO 47 Jl-1 , 6 

DO 47 J2M,6 

47 X< J1 , J2>=RECJti J2> 

M3 -2 

CALL MMULCX, Y, Nl , N2, M3, Z> 

DO 13 JIM >6 

DO 13 J2- 1 .. 2 

13 GGCKK , J1 , J2>-Z< J 1 * J2) 

DO 66 LI M ,6 
DO 66 L2M , 6 

66 FF < KK , L 1 , L2 > =EA< LI , L2 > 

CALL MMOL < RE , D , 6 i 6 / 2 , ZO 
DO 77 JIM , 6 
DO 77 J2» 1 , 2 

77 HHOCK, J1 , J2)-2CJ1,J2> 
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IT <K-30330 , 33, 30 

30 IF <K-60>35, 33, 35 

35 IF<K-90>36,33,36 

36 I F< K-LOC 1)32.31.32 

33 LOC2=30 
LOC3=LQC3+30 
GO TO 34 

31 LOC2=LOC 1 -LOC3 

34 CONTINUE 
KK = 0 

C 

C*** THE F. G, AND H MATRICES ARE STORED IN DATA AND ATEXT FILES 
C 

OPEN< 2 I .0 ,2, a I BUFF, 1 F-MATR IX ‘ ) 

WRI T£<21 > L0C2 / <<<FF<J1,J2, J3> , J3=l , 6) , J2=l . 6) , J 1 = 1 , LOGS'* 
CL0SE<2O 

0PENC21 , 0 , 2, 3 1 BUFF, ’ G-MATRIX 1 > 

UIRITEC2DL0C2, < < < GG< E 1 , K2 , K 3 ) , K3= 1 ,2>,K2=1 ,6),K1=1 ,L0C2> 

CLOSE < 213 

OPEN<2 1 , 0 .2-&:eUFF, 'H-MATRIX 1 > 

WRITE <213LOC2, < < C H H ( K 1 , K 2 j K3 ) , K3=l,2),K2=l,b),Kl=l, L0C2' 

CLOSE (21) 

IF<I-1)50 50, 6060, 5050 
5050 IF<I-NUM>32-70?Q-32 
6060 IF < FLAG >32, 8030 , 32 
7070 IF < K-LOC 1 532,3080,32 

8080 FLAG=1. 

OPEN<20 ,0 ■ 1 , 3I8UFF, 1 F-ATEXT 1 > 

WRITE <20, 20 20 > L0C2 , << <FF< J1 , J2, J3>, J3=l , 6 5 , J2=l , 6) , J 1 = 1 , L0C2 > 
20 20 FORMAT < 1 X , I 4 , „v , 1 20 < 6 < 1 X , 6F 12 . 5 , ✓ ) , /.• 5 !> 

CLOSE <20 ') 

OPEN <20 , 0 j 1 .31 BUFF, 1 G-ATEXT ' ) 

WRITE <20, 2121 >L0C2, <<<C-G<K1 , K2 , K3 > , K3=l , 2 5 , K2= 1 ,6),Kl=l- L0C2) 
2121 FORMAT < IX. 14,/s, 120 <6< 25X , 2F 1 2 . 5 , ✓ > , // ’> ) 

CLOSE<20> 

OPEN <20,0, 1,31 BUFF , ' H-ATEXT ' > 

WRITE <20 , 22225L0C2. << <HH<K1 , K2, K3? ,K3=1 , 25 , K2=i , 65 , Kl=l , LOC25 
2222 FORMAT < IX, 1 4 , /V , 1 20 < 6 C £5X , 2F 1 2 . 5, / > , <■' •* 5 > 

32 CONTINUE 
6 CONTINUE 
1 CONTINUE 
EXIT 
END 
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PROCRAW RIC 
C 

c«*« THIS PROGRAM SOLVES THE RICCATI EQUATION AND DRIVING FUNCTION 
C*+* THE FEEDBACK CAINS AND EXOGENOUS COMPONENTS ARE COMPUTED FOR 
O** USE IN THE FEEDBACK SOLUTION FOR EACH 3 SECOND TIME INTERVAL 
C 

C*** The DATA FILES CONTAINING THE DISCRETE-TIME F, G, AND H MATRICES 
C*** ARE USED AS INPUT 
C 

DIMENSION FF ( 3 1 , 6 , 6 ) , GG < 3 1 , 6 , 2 ) , HM ( 3 1 , 6 , 2 ) , GK6 , 6 ) , R ( 2 , 2 ) , S ( 6 * 6 ) , 
lF(6,6>,G<6,6>,FT(6,6),GT'6. 6>.ST<e,6>,Z<6,tO,OS <6,6>,D2(6',6). 
2D3(6,6>.D4(6, 6>,W1<2, I '> , W2C2, 1 ) - D5<6, 6) 

DIMENSION P<6,6),PP<3i,6,6>,GAIN<31,2,7), I BUFF (208), 06(6,6), 

1D7 (6,6) - H<6,6) 

COMMON-'MAINI.- NOIM,DUMl (6,6) 

ND I M=6 

WRITEC 10 , 5050 ) 

SO 50 FORMAT (IX, "ENTER HEAD-WIND IN KNOTS IN 3-D;CIT INTEGER FORMAT"/') 
READC 10,6060>NUM2 
6060 FORMAT < 13 ) 

WIND-NUM2 
N I ( 1 , l > =0 . 
till <2. 1 ) =-W I ND+ 1 .69 
(02(1/0=0: 
tt)2(2, 1 )=-W IND+ 1 . 69 
DO IS J=l,6 
DO IS JJ=1,6 
S(J, JJ)=0 . 

ST< J, JJ>=0 . 

P<J, JJ>=0 . 

IS Q(J,JJ)=0. 

DO 20 J=l,6 
20 D5(J,l>=0. 

C 

C*** THE STATE, CONTROL AND CROSS-TERM WEIGHTING MATRICES 
C 

0(1, t>=. 72 
0(2, 2)=.5 
Q ( 3 , 3 > =80 0 . 

Q<4, 4 >=75. 

Q(5,5>=. 88E-2 
0(6, 6 )=. 55E-5 
R(l,2)=0. 

R ( 2 , 1 ) =0 , 

R( l , 15 = .39E-4 
R<2,2)=. II 

SC 1, I >=SORT (0(1, 1 >*R( 1 , 1 > ) 

S<2 , t j=S0RT(0(2, 2> *R < I , 1 ) ) 

S<3, 2/=SGRT<GK3,3)*R(2,2> > 

S(4, 2 >=S0RT(Q(4 ,4>*R(2,2>> 

SO , 2 >=S0RT <0(5,S)*R<2,2)> 

S<6, I>=SQRT(0(6,6>*R<1, 1 ) > 
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c 

C*+* THE TERMINAL TIME STATE WEIGHTING MATRIX 
C 

P< 1, 1) = I. 

PC2,2)=Q<2,2> 

P<3/3)=QC3i 3 ) 

P<4#4)-GK4j4> 

P<5i5:> = .99E-2 
P<6,6)=.22E’4 
WRITER 10 r 100 > 

100 FORMAT < 1 X . 11 ENTER 2-DIGIT OCTAL NUMBER OF F-G-H MATRIX SET FILE 
l/> 

READ < I 0 i 10 1 > MUM 

101 FORMAT c 02; 

DO 1 I = 1 > NUM 

I X=3*NUM-3*I+1 
I 11 = 11 + 1 

OPEN C 2 1 iQ *2 1 S I BUFF * 1 F-MATR I X ' > 

REWIND 21 
I F < I I - 1 > 3 / 2 , 3 

3 DO 4 J=2> II 

4 SKIPFILE 21 
2 CONTINUE 

READ <21 >LGC2.* < < <FF< J 1 , J2, J3), J3=t - 6) ♦ J2=l,6> , Jl = l ,L0C2> 

CLOSE< 2 1 > 

OPEN <2 1,0 ,2, a I BUFF, ^-MATRIX* J 
REWIND 21 
DO 5 J=l # II 

5 SKIPFILE 21 

READ <21 )LOC2 * < < < GG < K 1 , K2 , K3> , K3= 1 , 2 > > K2= I , 6 >, K 1 = 1 , L0C2) 

CLOSE < 21> 

OPEN <21 >0 r 2.> a IBUFF t 1 H-MATRIX* ) 

REWIND 21 
DO ?5 J=l, III 
95 SKIPFILE 21 

READ <2 1 >LOC2> < C < HH < K 1 > K2 , K3 ) , K3“l , 2) 2=1 ,6> , Kl=* , L0C2) 

CLOSEC21) 

DO 6 K=1 > LOC2 

JK=L0C2-K+l 

DQ 7 J- 1 < 6 

DO 8 JJ=L,6 

F C Ji J J )=EF < JK, J » J J > 

8 FTC JJ, J>=FF< JK.-J* .IJ> 

DO 7 JJ=!,2 
H<J/JJ>=HHCJK*J/JJ) 

G<J> JJ)=GG<JK> 

7 GT< JJ # J>=GG< JK, J j JJ ) 

CALL MMULtH r W 1 , 6 # 2 # LZ) 

DO 77 J=L>* 

77 D6CJ, l)=ZCJ, 1) 

CALL MMUL<P,D6,6>6, 1 , Z> 

DO 21 J=t,6 
21 D6CJ, 1>=Z(J, 1) 



CALL MMUL<GT,P,2,6,6 >Z> 

00 ID J = 1 >Z 
00 U JJ=1,6 

10 D1 < J , JJ) -Z( J J J ) 

CALL MMUL < D 1 , F , 2 , 6 , 6 , Z > 

DO 9 L=l,2 
DO 9 LL - 1 t 6 

9 OK LiLDeSTCLj LL)+Z(L,LL> 

CALL MKUL<GT,P, 2, 6, 6, Z) 

00 11 J*K2 
00 11 JJ=t,6 

11 D2<J, JJ>=Z( J, JJ> 

CALL MM(JL<D2,G,2i 6,2, 2) 

00 19 J=l,2 
00 19 J J = 1 <2 

19 Z < J .♦ J J / =2 < J , J J > +R C J # J J ) 

RR-Z< 1 } t?*Z<2,2>-Z<K2>*ZC2, 1> 

D2C1, 1>=Z<2,2)/RR 
D2<l,2>=-ZO ,2'^RR 
D2<2, 1 >=-ZC2, 1 >/RR 
D2 < 2 , 2 > = 2 <! 1 i t >^RR 
D3< 1 , n=02< M) 

D3< 1 i 2 ) =D2 < 1 .■ 2 5 
D3<2. 1)^02<2, 1 ) 

03<2>2)=D2C2i 25 

CALL MMULCD2, 01 , 2,2,6, Z> 

C 

C++* STORE FEEDBACK GAINS 
C 

DO 12 J=l,2 

DO 12 J J= 1 ,6 

GAINCJK, J, JJ>=-Z(J, JJ> 

12 DHL J >=Z<J, JJ: 

CALL MUL<D3,GT,2,2,6,Z) 

DO 22 J=L2 
DO 22 J J = 1 6 
D4CJ, JJ>=Z<J, JJ> 

22 D‘% ■ :> JJ)-Z<J ■ JJ> 

DO 24 J = 1.6 

24 D7 < J 1 > = D5< J, 1 >+D6CJ, 1 > 

CALL MMUL<D3,D7,2.6, 1,2: 

C 

C*** SVOftE FEEDBACK L>-i.. *' vftPONENTS 

C 

DO 23 J=*l,2 

23 GAJ N< JK, J i 7>=-ZC J, 1> 

CALL MV4UL < FT > P , 6 , 6 » 6 > Z > 

DO 13 J=l,6 

DO 13 J J = 1 ,6 

13 D2<J, JJ) 

CALL MMULCD2,G,6,6,2, Z> 
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DO 14 J*l,6 
DO 14 J J = l » 2 

D2<J,JJ)~$(J,JJ)+Z<J,JJ) 

14 D3<J, JJ)=D2< J , JJ) 

CALL MMUL<D2,D1,6,2,6,2) 

DO 15 J = 1 j e 
DO 15 JJ=1.6 

15 D KJi JJ) = Z<J/ JJ) 

CALL MMUL<FT,P,6,6,6,Z) 

DO 16 J-1,6 
DO 16 JJ=1,6 

16 D2< J , JJ >=2< J , JJ > 

CALL MMULCD2,F,6,6,6,Z> 

DO 17 J- 1 , 6 
DO 17 JJ=1,6 

P<J, JJ)=QC J, JJ)+Z<J, J J)-Dl CJ, JJ) 

17 PP<JK> J, JJ)=P<J, JJj 
CALL MMUL(D3,D4,6,2,6,Z) 

DO 25 J=l,6 

D7C J, 1 )=D5<J, I )+D6< J, 1 > 

DO 25 J J = 1 ■ 6 

25 D3< J, JJ>-FT< J, JJj-ZCJjJJ) 

CALL MMUL<D3,D7,6,6, L2) 

DO 26 J«1 , 6 

26 D5 t J , 1 )=Z<J, 1 ) 

6 CONTINUE 

OPEN C 2 1,0. 2, SI BUFF > 'GAINS' > 

WRITE<21 >L0C2, < <<GAIN<K1 ,K2, K3) ,K3=1 , 7>, K2=l , 2>,Ki=l LOC2) 

CLOSE 1 2 1 ) 

IF< 1-1)7171,7272, 7171 
7171 IF Cl -NUM) 7373, 7272, 7373 
7272 CONTINUE 
C 

C*** THE R1CCATI SOLUTION, FEEDBACK GAINS , AND EXOGENOUS COMPONENTS 
C++* ARE STORED IN DATA AND ATEXT FILES 
C 

OPENC20 , 0 , 1 , a I BUFF , ' P-MATRtX' ) 

WRITE <20 , 20 20 ) LGC'2 , C C <PP< J1 , J2, J3) , J3*l , 6 ) , J2 = 1 , 6 > , J 1 = 1 , L0C2> 

20 20 FORMAT < IX, f 4 , , £0 < 6 < 1 X , 6F 1 2 . 4 , ✓ ) , ✓ ✓ > ) 

CLOSE <20 > 

7373 CONTINUE 

OPEN <20 ,0 , 1 , Q I BUFF, 'GAINS') 

UJRlTE<2i) , 2121 >L0C2> < < <G A I N C K 1 , K2 , K3 ) , K3= 1 , 7 ) , K2= 1 , 2> , K 1 = 1 , L0C2 > 
2121 FORMAT < 1 X j I 4 , /v , 60 < 2 < 1 X , 7F 1 0 .4, /),//) ) 

CLOSE < 20 ) 

1 CONTINUE 
EXIT 
END 
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PROGRAM REG 
C 

C*** THIS PROGRAM IMPLEMENTS THE LINEAR FEEDBACK SOLUTION ON 
C*+* THE COMPLETE NONLINEAR AIRCRAFT MODEL OF THE BOEING 707-320B 
C 

C*** THE DATA FILES CONTAINING THE NOMINAL STATE AND CONTROL VALUES 
C*** AND THOSE CONTAINING THE FEEDBACK GAINS AND- EXOGENOUS COMPONENTS 
C*** ARE USED AS INPUTS 
C 

C*** FUNCTION SWITCH 4 RESETS INITIAL CONDITIONS 
O** FUNCTION SWITCH S STARTS PROGRAM 
C*** FUNCTION SWITCH 12 STOPS PROGRAM 

C*** FUNCTION SWITCH 16 DISPLAYS FLIGHT CONDITIONS AND PARAMETERS AT 
C<»** TERMINAL TIME OR AT STOPACTION 
C 

GLOBAL ITIME, NF 
IMPLICIT FRACTION <F> 

LOGICAL CONE 
REi' >~ FLAPS 

L OTS£RRORS=SHOPT 

COMMON/MORE/ I BUFF <20 8) , TP (75) -EE (75) , T0TT<75) , SUK6, 6) , RUH2, 2) 
COMMON/RELAX/SCORD, SSPAN, SAREA, P , 0 , ROW , RMACH , DPP , DQG , DRR , SPALF 
CQMMON/IHORK/UVEL, VVEL , UIVEL , VTOT , UPTT, VDTT, IflDTT, VTOD 
COMMON/EXTRA/DDFIE,DDTET, DDSY,RFIE, RTET , RSY , STTET , CTTET, SF IE , CFI E 
COMMON /MORE/ SSY , CSV 

COMMON/CNTRL/T, FLAPS, CTETA . CPH I .■ CXI , GEAR.. SPBRK, TP03 
COMMON^CNTRL-'BTETA , BPMI .. BX I 
COMMON ''PRMTR/V , XI , BETSG,DT 

COMMQN/PRMTR/ ALPHA , BETA, PHI , VX, VY, VZ, THETA, A , XM , Y , R , R I AS 
COMMOH/FfiAC/FV, FBNK, FPICH , FA, FVZ, FHDG, FADF , FVOR, FCPICH 
COMMQN/FRAC/FER, FHER, DME<6), ALT<?) 

COMMON/FD/ADF, VOR, EPS , HER, RAD 

CQMM0N/GAINS./GAIN<31 , 2 , 7 > , UU U 0 0 > , WWC1 00 ) , QGK 1 00 ) , TEETUOO > , JK5 , 
1HH< 100 ) , RANGE*: 100 ) , LOCI , LOC2, JK 1 , JK2 , C TIM, TOT XX, JK3 , DELU, DELW, 
2DELG, DELT,DELH, DELR, DELTM, DELE, D 1ST, THU 0 0 > , JK4, NUM1 , NUM2, WIND 
DATA TMRKRl/0 .4815/, TMRKR2/0 . 068/ , TNRKR/0 .0076./ 

DATA TNGSA/-0 . 052933/ . RAD,'57 . 296/ 

DATA SC0P0/34143. /, SSPAN/2 19354 . /, SAREAU 50 5 . /' 

ENTRY NF 
WRITEC 10 , 5050 > 

5050 FORMAT OX, "EN TER HEAD-WIND IN KNOTS IN 3-DIGIT INTEGER FORMAT” / > 
READ< 10,6060 >INUM 
6060 FORMAT < I 3) 

RNUM= I NUM 
WIND=-RNUM+I . 69 
WRITE< 10 ,1010) 

1010 FORMAT* IX, "ENTER TOTAL NUMBER OF VALUE FILES IN OCTAL"/) 

REAP* 10 , 2020 )NUM1 
2020 FQRnAT < 02) 

WRITEUO , 3030 ) 

3030 FORMATUX, "ENTER TOTAL NUMBER OF GAIN FILES IN OCTAL"/) 

READ< 10 , 4040 ; NUM2 
4040 FORMAT < 02 ) 

HR I T£ ( 10,7070 ) 

7070 FORMAT* IX, “TYPE 1 FOR EXOGENOUS COMPONENT- OTHERWISE 0"/) 
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READU0,e080 >JK5 
8080 FORMAT ( 0 1 > 

1 CONTINUE 
C 

C++* INITIALIZE ALL VALUES 
C 

DO 124 1=1,6 
DO 124 J=L,6 
124 QlflCI, J>=0 . 

QttKl, l>=,72 
Qli) C 2 * 2 ) = < 5 
QtU < 3 , 3 ) =80 0 . 

QW <4/4 ) *75 . 

QW< 5, 5)= > 88E-2 
QW<6,6>=*,55E-5 
RUK1/ 1 >=, 39E-4 
RttCl ,2>=0 . 

RUJC2, 1 >=0 . 

RUJ<2,2> = . 1 1 
COSTCO . 

JK1-NUM1+NUM2-1 

JK2-1 

JK3=0 

JK4--1 

LOCI =0 

LOC2»-10 

TOTXX=0 . 

CT I M=0 * 

DELU=0 . 

DELltf=0 . 

DELQ-0 . 

DELT=Q . 

DELH=0 . 

DELR^Q . 

DELTH-0 . 

DE!.E=Q , 

SPALF =0 , 

DDF IE=Q , 

DDTET=G , 

DDSY=0 , 

RF IE=0 . 

RTET=, 84/RAD 
RSY=53, 07/RAD 
STTET=SIN< ,015) 

CTTET = COS < ,015) 

$FIE=Q . 

CFIE=1 . 

SSY- * 79937 
CSV =*60 0 839 
XI =53 * 0 7 
PH I =0 . 

FBNK=0 , OF 
ALPHA=2 . 84 
BETAC=0 , 

BETA=0 , 
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DRNG-255Q « 

IM=0 

jjr f»q 

ETIME=TOTTX=0 . 

XM=- 150 , 26 
Y=- 239497 , 19 
VQR=53 . 0 7 
ADf c 49 . 69 
V=4 76 , 

VT0T-30 4 . 

VTOD=0 t 

uvel«vtot 

WEL = 0 , 

UlVEL=Il .0 
UDTT*0 . 

VDTT=Q . 

WDTT = Q . 

VX-764 . 65 
VY=243 , 45 
77=0 . 

P- 0 . 

Q=0 . 

R = 0 . 

DPP=0 , 

DGQ-0 . 

DRR=0 . 

THET ft = ALP HA- 2 , 

DIST=SGRT < CXM+31 , 0 826 > **2+ < Y/60 80 . 2 + . 50 366) + *2) 

TISD=DIST 

A-3500 Q . 

I ALT 1 =3 
IALT2=5 
1 ALT3=0 
IALT4 =0 
IALT5=0 
LABELCALT' 

zseko . on 

WOVE< .61F, , 39F ) 

MRITEC 16, 90 ID I ALT 1 > IALT2, IALT3, I ALT 4 j 1 ALTS 
90 U FORMAT *21 n “95 M X , 3 I 1 ) 

ENDLTST 

LABEL<DME> 

ZSETCO . F > 

MOVE< -0 . 34F / -0 ( 01434F) 

WRITE* 1 6 . 555) D 1ST 
ENDLIST 

XFEET = XM*60 80 . 2 

£PS=ATAN<<Y+3062 . 35) ✓ < <XM + 3 1 . 06 1 6 > *6080 . 2 > ) 
HER=A-XFEET*'>0 .052933) 

BTETA=BPHt=BXI=Q . 

CALL SAMPLE 
BTETA=CTETA+2, 1 
BPH I =CPH 1 
BXI-CXI 
CALL RTOF 
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c 

C**» START THE DISPLAY 
C 

A JPSR iGRAFX 

A ♦DIALS 

A 5 

C 

C*** INITIALIZE DATA-UPDATE CLOCK 
C 

2 I T I ME= 1 

C 

C + ** ENTER WAIT LOOP IF SWITCH 8 (START) IS NOT ON 
C 

IF( . NOT t SWITCH<8>)G0 TO 2 
C 

C*** EXECUTE UNLESS SWITCH 12 (FREEZE) IS ON 
C 

C*** READS FEEDBACK GAINS AND EXOGENOUS COMPONENTS 
C 

IF< JKI-NUttl+1 )859, 859, 6 
6 I F < JK3-LOC2 ) 859 j 86 0 , 860 

360 OPEN (21 , 0 i 2, 9 I BUFF, 'GAINS') 

REWIND 21 

IF< JK1 >851 - 853,351 

851 DO 852 Jl = l v JK 1 

852 SKIPFILE 21 

853 READ (21 )L0C2, C ( CGA I N CK 1 , K2 , K3> , K3=l , ?> , K2 = 1 , 2> , K 1 = 1 , L0C2) 
CLOSE < 2 1 ) 

92 JK 3 = 0 
91 CONTINUE 
JK1=JK1-1 
t T IME- 1 
C 

C++* READS NOMINAL STATE AND CONTROL VALUES 
C 

059 IF<L0C1-JK4)854, 866, 366 
866 IF<JK2-NUM1-1>855,854,854 

855 OPEN(21 , 0 , 2, 3 I BUFF, ' VALUE! ' ) 

IF< JK2-1 >856,857,356 

856 DO 353 J1=2,JK2 
858 SKIPFILE 21 

857 RE AD (21 >L0C1 , OJU ( I ) , UJID < I > , QQ C I ) , TEET < I > , HH ( I ) , RANGE C I> ,TH< I > , 

itp< i) ,cr:< i) , tott< n , 1 = 1 , loci > 

CLOSE < 2 l > 

JK4=L0C[ 

JK2= JK2+ I 
CT TN=CT IM+21 0 * 

LOCI =0 
ITIME=I 

854 CONTINUE 
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c 

O** THE DEVIATIONS IN THE STATES AND CONTROLS ARE PRINTED 
C«** ON THE TELETYPE EVERY 6 SECONDS 
C 

1F(AM0D(T0TXXj6, > , GT . DT ) GO TO 9181 

WRITE' 10 ,6161 >DELU>DELUI, DELQ.DELT, DELH, DELR, DE!_TH. DELE 
6161 FORMAT O X , F8 . 2 ■ F7 . 2 , F8 . 4 , 2X , F8 , 4, FI G , 2 , F 1 0 , 2 , F 1 0 , 2 
l,2X,F6.2> 

I T 1 ME" 1 
8181 CONTINUE 

IF< .NOT.SWITCHC 12>>G0 TO 3 
C 

C*** AFTER SWITCH 12 HAS BEEN PRESSEDi EXIT IF SWITCH 16 IS ON,, 
C 

7 IF<$U!ITCH< 1 6 ) ) G 0 TO 4 
C 

C + * 1 '* OR INITIALIZE VALUES IF SWITCH 4 CIO IS ON... 

C 

IF < SW I T CH < 4 > ) GO TO 5 
C 

C++* OR START EXECUTION AGAIN IF SWITCH S IS ON... 

C 

IF<SWITCH(8>)G0 TO 6 
C 

C*** OR INITIALIZE DAT A-UPDF7E ■ !' Aft? ENTER A WAITING LOOP 

C 

ITIME-1 
GO TO ? 

3 CONTINUE 
C 

C*+* STOP THE DISPLAY AND GO BACK TO INITIAL VALUES 
C 

A JPSR iNHALT 
A NOOP 

GO TO l 
C 

+ * START EXECUTION OF A NEW DATA-UPDATE CYCLE! 

C+** COMPUTE DT <=TIME IN SECS OF PREVIOUS CYCLE) 

C*** AND INITIALIZE DATA-UPDATE CLOCK 
C 

3 T 1 M£= I T I ME 
I T I ME-0 
DT*TIM£/120 . 

CALL DYNNF 

XFEET = XM=*6G 80 . 2 

IF< XFEET , ED . 0 . )XFEET = 1 . 

YMILE“Y^6030 .2 
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c 

C++* COST FUNCTION 

c 

COST = CGST+DELU*QUK 1 , 1 > +DELU+DELW*GW < 2 f 2 ) *DELW + OELG + OUI C 3 , 3)*DELO 
L +OELT + QW< 4 « 4 > * DEL T+DELH+ Q(D C 5 , 5) *DELH+DELR+Qlll<6 , 6 > + DELR 
2+DELTH*RWCl , I > *DELTH+DELE + Rld<2 , 2> *D£LE 
HER=A-XFEET*TNGSA 
IFCXM*EQ.-31 . 0 826 > XM--3 1 ,0 827 
EPS=ATAN< CYMILE+ . 50366) '<31 . 0826+XM) > 

IFCXM. EO . -5. 4396 >XM* -5. 4895 
C 

C * 4 1 * VOR, RDF AND DME INFORMATION 
C 

ADF=35 . -ATAN<YMiLEX-XM-5 . 4896 ) > *RAD 
IF C.XH , GT . -5*4896) ADF -hDFMSO . 

IF C XM . EO. -31 .0826>XM=-31 ,0316 

VOR = 35 , -PThNC < YMILE+ . 50366) ><-31 . 0826-XM) ) AD 
l F < XM . GT . -3 1 . 0 826 ) V OR = V OR+ 1 3 0 . 

ADF=AMQD C ADF , 360 . > 

VOR=AMOD< VOR i 360 . > 

CALL R T O F 

D I ST = 3QRT ( C XF-t+3 1 . 0 326 >+*2+ < YM I LE+ , 50366)+*2) 

LABEL < DME > 

ZSETC0 ,0F) 

MOVEC-G * 34F , -0 pO 1434F) 

WRITER 1 6 t 555) D 1ST 
555 FORMAT < “V" 1 ' f M ) 

ENDLIST 
RALT*- ' - . 

ialt: ‘tv \ 

R ALT -tO . ♦ < RALT- IALT 1 > 

I ALT2=RALT 

RALT=tG p*<RALT-1ALT2> 

IALT3=RALT 

RALT = 10 . + < RALT - I ALT3 > 

IALT4=RALT 

RALT- i 0 . *■ < RALT- 1 ALT 4 > 

I ALT5-RALT 
LABEL'ALT) 

2SET < 0 . OF) 

MOVE < .61F, . 39F ) 

WRITE* 16, 90 12) I ALT 1 , IAI.T2, I ALT 3, IALT4, IALT5 
90 12 FOR MAT <21 L "aSMX, 311) 

ENDLIST 
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CQNE = , FALSE . 

JGM=IMM=I IPI = 0 

I f< EPS , LE-0 . 05 . AND . EPS . GT . -Q . 05 >CONE = . TRUE . 

C 

C*** TURN OUTER MARKER LIGHT ON 

C 

IF(ABSO<M + 5.4896) . LE , THRKR t . AND . CONE> I OM- 1 ‘ 

C 

O** TURN MIDDLE MARKER LIGHT ON 

C 

IF < ABS < XM + 0 . 7396) , LE . TMRKR2 , AND < CONE > I MM = 1 
C 

C+*+ TURN INNER MARKER LIGHT ON 

C 

IF<ABS<XM+0, 1896). LE.TMRKR. AND. CONE >1IM=L 
CALL BEACONS ( I OM, I MM , I I M , J J FF > 

C 

C*** EXIT IF ALT I TUDE = G 

C 

IFCA)4,4,6 
4 CONTINUE 
C 

o** STOP THE DISPLAY, TURN ALL LIGHTS OFF 
C 

A JPSR 4NHALT 

XFF=XM*60SO .2+1153. 

KDT = l . SQJ 
C 

C*** SHOW PARAMETERS AT TERMINAL TIME OR AT STGPACTION ON CRT SCREEN 
C 


2000 
200 1 


TSID = DIST + <$080 ,2 
WR1TEC25, 2000) 

UJR 1 TE < 25 * 20 0 t ) TOTXX , R I AS , X I 
WR1TE< 25 , 2002) VZ 

WRITE<25,2003>UVEL,UIVEL.G,THETA, A, DIST, TPOS, T,CTETA 

FORMAT <^///27X* "PARAMETERS AT TERMINAL TIME OR AT STOPfiCTIGN' 


//> 


F0RMATC27X. "TOTAL FLIGHT TIME 

2 27X, * INDICATED AIRSPEED 

3 27X, "HEADING 

2002 F0RMAT<27X, '‘VERTICAL SPEED 

2003 FORMAT < /*27X , "FORWARD VELOCITY U 

1 27X, "DOWNWARD VELOCITY W 

2 27X, "PITCH RATE 

4 2?X , "PITCH ANGLE 

5 27X , "ALTITUDE 

8 27X, "RANGE 

627X, "THROTTLE POSITION ",14X,F6 

7" LBS , ,r , s i 27X , "ELEVATOR POSITION 
WRITE<25, 2004)tDST 
2004 FQRMATC/, 27X, "COST 
EXIT 
END 


F 1 5 . 0 .. " SECS."/ 

#8X,F7. 1 * “ KNOTS"/ 

, 10X,F5. 1 , " DEG.") 
i F 1 5 . 1 , “ FPM" ) 

, 10X,F7. 1, " F T./SEC.' 1 / 

, 1 0 >w F 7 , 1, " FT ./SEC. *V 
, 13X,F7.4, " RAD. /SEC. "/ 

, 13X,F7.4, " DEG. "/ 

, 10X,F6.0, " FT. *•/ 

, 1 IX, F6 . 1 , " NAUT , MI * H / 

4 , / , 27X , "THRUST" ,25X,F8. 1, 
", 13X,F5.2, " DEG. " > 


,F15, 1) 



subroutine sample 
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c 

o** SUBROUTINE TO SAMPLE COCKPIT CONTROLS 
C 

GLOBAL SPBRK, FLAPS, THRUST 
IMPLICIT FRACTIdNCF) 

REAL FLAPS 

COMMON/ MO R E/IB UFF ( 2 0 3 > , TP <75? , EE < 75 5 , TOTT < 7 5 > , OUK 6 , 6 ) , RHK 2 , Z > 
COMMON/RELAX/SCGRD , SSPAN , SAREA , P .* Q , ROW , RMACH . DPP * OOO , DRR , SPALF 
COMMON/PRMTR/V, XI v BET AG, OT 

CQMM0N/PRMTR/ALPHA,6ETA,PHI , VX, VV, V2 , THETA , A , XM , Y , R f R I AS 
CGMMON/CNTRL/T, FLAPS, CTETA, CPHI , CXI , GEAR , SPBRK , TPOS 
COMMON/’CNTRL/BTETA,ePHI , BXI 

COMMON/GAINS /GAIN <31 , 2 , 7 > , UU < I 0 3 > , m C 1 0 0 > , QQ C 1 0 0 ) , TEET < 100 ) , JK5 , 
1 HH C 10 0), RANGED 100 ) , LOC 1 , L0C2, JK 1 , JK 2 , CT I M , TOTXX , JK3 , OELU , OELU, 
2DELG, DELT,DELH,DELR, DELTH, DELE , 0 1 ST , TM v 1 0 0 > , JK4 , NUM 1 , NUM2, WIND 
A ADEPT 

FPRI 

MDO? ' F 0 

o;o;o 

MDO 7 1 F 10 

o;o 

S5M0 FSPBRK 
MDO 7 1 F 20 

o;o 

S5MD FT 1 
MDO 7 1 F 40 

o;o 

S5MD FT2 
MDO 7 1 F 100 

o;o 

S5MD FT3 
MDO 7 * F 200 

o;o 

S5MD FT 4 
MDO 7 ' F 0 

o ; o ; o 

MDO 7 1 H Cl 

o;o;o 


ORIGINAL PAGE IS 
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DONNi 


MASK! 
ZERO: 
ONE ! 
FGEARV 
FSPBRK : 
FT 1 : 

FT2 i 
FT3 : 

FT4 t 
Ct i 

FFLAPS s 
FYOKE: 
FWHEEL i 
FPEDL : 
BACK: 
MASK'JP : 
MASKDN: 


MDO 7 * L * 1 ! H 1 

o;o 

S3MD FFLAPS 

MOOZ'L; 1!H2 

o;o 

S5MD FYOKE 
MD07’L; 1 ! H4 

o ; o 

S5MD FUJHEEL 
MO07 f L; l ! H 10 

o ;o 

S5MD FPEDL 
MDO 7 ' H Cl 

o;q;o 

UPRI 

MDAR MASK 
S6AR 4 A 1 F 
ARAR 4 h 1 f 
JPLS DOWN 
MDAR ZERO 
ARMD FGEAR 
JUMP BACK 
MDAR ONE 
ARMD FGEAR 
JUMP BACK 
00100 ! HO 
0 i HO 

0 i H'37777 
0 
0 
0 
0 
0 
0 

0 f HQ 000 1 
0 
0 
0 
0 

NOOP 

10000 

04000 
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HOAR MASKUP 

SfeAR "AT 
JPLS SUJUP 
HOAR MASKDN 
S6AR 1 A * F 
JPLS SUIDN 
JUMP SUJEN 

SHUP: NOOP 
rORTRAN 

8TETA=8TETA+ ,05 
A ADEPT 

JUMP SUES 
SOON: NOOP 
FORTRAN 

BTETA-BTETA- . 05 
A ADEPT 

SWCN : NOOP 
FORTRAN 
C 

C*** MACH NUMBER 
C 

IF < A-36039 . >90 04,900 4,90 05 

9004 RMACH“V-'<661 0Q2434*A> > 

GO TO 9006 

9005 RMACH=V/573. 

9006 CONTINUE 
C 

C*** INDICATED AIRSPEED IN KNOTS 
C 

R I AS= <656 . -< , 00 9 t *A) ) *RMACH 
SPBRK=FT0R<FSPBRK>*18? . 5 
IFCR IAS-1 88 . >90 0 7, 90 0 7, 90 0 8 
9008 SPMAX=60 , 233* <R I AS-18S . > > 

SPBRK = AMIN1 < SPBRK , SPMAX> 

9007 CONTINUE 

FLAPS = AM AX2C0 . OF , FFLAPS>*128 .315 
IF <FLAPS-3PALF>90 0 1,9002,9003 

9001 FLAPS=SPALF- , 4175 
GO TO 9002 

9003 FLAPS=SPALF+ , 4175 

9002 SPALF=FLAP3 

CTETA=(-FT0R<FY0KE>*13, 75-BTETA > *2 . 0 
CPHI = <-FT0RCFUJHEEL>*42. 5-BPHr/l . 85>*1 .85 
CXI-CFTOR(FPEDL>*20 , 5- BX I /Z , 65 > *2 . 65 
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C 

C*** THRUST COMPUTATIONS 
C 

THRUST=FT0RCFT1+FT2> +FTORC FT3+FT4 > 

TP0S=<THRUST-.372?>/'l , 1761 
TPOS=AMAXl CQ , , TPOS> 

CTETA-AMAX1 C-20 . , CTETA) 

TPOS=AM I M 1 C TPOS , 1 .0 > 

CTETA=AM1N1<CTETA,20 . > 

IF < A- 1 0 0 0 0 , ) 820 > 32 1 ,821 

820 RMAXT= 1 380 0 . 23125*A-K .31 17+A-7800 . >*RMACH 
R 1 OLT= 10 0 0 .-2000 -•■RMACH 

CO TO 922 

821 RMAXT = 1 390 0 . - . 28 1 2‘.»* A-M . . 1 Z* < A- 1 0 0 O 0 . > -3 1 25 , ) ♦RMACH 
R I OLT = 10 0 0 .+< .05* <A~ 10000 . >-2000 . )*RMACH 

822 ridlt=ama>;kridlt, 0 . > 

7 - < R I DL.T+ (RMAXT-R I DLT> *TPOS*TPOS) *4 . 

JK6=JK3+1 
R JK5= JK5 
C 

C + * * THRUST = NOMINAL THRUST + THRUST DEVIATION FROM FEEDBACK LAW 
C*** ELEVATOR DEFLECTION = NOMINAL DEFLECTION + DEVIATION 
C*** THRUST AND ELEVATOR DEFLECTION ARE NOT ALLOWED TO EXCEED LIMITS 
C 

99 T=THCL0C1+1 l+GAINC SK6 , 1, l> *DELU+GA I N < JK6 , 1 , 2> *DELIfl+GA I N C JK6 , 1 ,3) 
1*DELQ + QA INC JK6 , 1 , 4> +DELT -*-GA INC JK6„ 1 , 5> +OELH+GA I N < JSCS , 1 . 6>*DELR 
2-CGhJNC JK6, 1 , 7>*lilIND*R.JK5''C 15 . ♦ 1 , 69 > > 

RM AXT = 4 . *RMAXT 
R I DLT=4 . *P.IOLT 
T=AMIN1 CT, RMAXT) 

T = AMAX 1 CRIDLT, T> 

CTETA=EE<L0C1+1 )+GAINC JK6,2, 1 ) *DELU+G A I NC JK6 , 2, 2) *DELW+GA INC JK6 , 2 
1 , 3>*0ELQ+GAIN< JK6, 2, 4 > *DELT+G A I N< JK6 , 2 , 5> ♦DELH+Gh I N< JK6, 2 , 6 ) *DELR 
2-CGA INC JK6 , 2, 7 > + WIND*P JK5^< 1 5 . * 1 .69)) 

DELTH=T-THCLOCt+l > 

DELE=CTETA-EECL0C1+1> 

96 CONTINUE 

CTETAsAMAXl C-20 . , CTETA> 

CTETA=AMIN1CCTETA,20 . ) 

TMAX l =4 . + PMAX.T 
TM I N 1 =4 . *R I DLT 
206 GEAR=FTORCFGEAR> 

RETURN 

END 
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SUBROUTINE BEACONS C I OM . 1MM> I I JJFF > 

C 

subroutine to OPERATE BARKER-BEACONS * LIGHTS 

c 

IFCIOM, OR. I MM. OR, 10 

9 CONTINUE 

J JFF=J JFF+1 
GO TO (S. 8,6, ICO, JJFF 
8 CONTINUE 

IFC IQM>1,4 
4 IF<IMM)2,5 

5 IFUIM>3,6 
C 

C*** NONE OF THE LIGHTS SHOULD BE ON s 
+ TURN THEM ALL OFF 
C 

10 JJFF =0 

6 CONTINUE 

A ADEPT 

MOAR BCN 
ARIC'A'F 
JUMP .+2 

BCN: 77277 IH57777 
NOOP 
FORTRAN 

GO TO 7 

1 CONTINUE 

A MDAR OUTER 

A ARIC'O 

GO TO 7 

2 CONTINUE 

A ttDAR MIDLE 

A ARIC’O 

GO TO 7 

3 CONTINUE 

A MDAfi INNER 

A ARIC'O 

GO TO 7 
A ADEPT 

OUTER f 20 0 0 O 
M IDLE : 0 0 40 Cl !H 
INNER : 00100 1H 
FORTRAN 

7 CONTINUE 
RETURN 
END 


L 3 


ORIGINAL PAGE IS 
OF POOR QUALITY! 



SUBROUTINE DYNNF 


C 

C*** DYNAMICS-COMPUTING SUBROUTINE 
C 

global ovz.dt, mp, app, dp, dq, dr, p, q, r 

GLOBAL CXI, CPHl.CTETA, ALPHA, BETA 

GLOBAL UVEL, WEL, UJVEL, RVX, RVY, RVZ, UDOT, WDOT, VDOT, VTOT 

GLOBAL THETA, PHI, XI, L,D,SFOfi 

GLOBAL LLL , MMM , NNN, RF I E, RTET , RS Y , V, RX , RY , RZ 

REAL L, FLAPS, LLL. MMM . NNN 

COMMON/MORE/ IBUFFC20 3 5 , TP < 755 , EE<75> . TOTT ( 755 . QUK6. 65 , RW < 2 , 25 
COMMOtJ/RELAX/SCQRD, SSPAN, SAREA, P , Q , ROW, RMACH, DPP • OQQ, DRR, SPALF 
COMMON-'UlORkVUVEL, WEL, UVEL , VTOT , UDTT , VDTT , WDTT , VTOD 
C0MMQN/EXTRA/DDF1E, OCTET , DC'S Y, RFI E, RTET, RSY, STTET, CTTET , SFIE, CFIE 
COMMON /MQRE/SSY , CSY 

COMMON/CNTRL/T, FLAPS, CTETA, CPHI, CXI , GEAR, SPBRK,TPOS 
COMMON/ CNTRL/BTET A , BPHI , BXI 
COMMON/PRMTR/V , XI , BETAG, DT 

COMMDN/PRMTR/ALPHA, BETA, PHI , VX, VY, VZ, THETA, A, XM, Y,R,RIAS 
COMMGfN/FD/ADF , VOR, EPS, HER, RAD 

COMMON- 'GAINS /GAIN <31 , 2, 7 > , IJUC 100 5 , WW< 1 0 0 5 , G6K 1 00 5 , TEETC1 00 5 , JK5, 
1HH< 100 5, RANGE ( 10 0 5 , LOCI , L0C2, JK1 , JK2, CT1 M, TOTXX, JK3, DELU, DELW, 
2DELQ, DELT, DELH, OELR, DELTH, DELE. D 1ST, TH< 100 5 , JK4, NUM1, NUM2, WIND 
CALL SAMPLE 
V2= VTOT* VTOT 
C 

£>** ATMOSPHERIC DENSITY 
C 

ROW= . 2378E— 2+< A*< < A/ C 1 . 806E12 5 5-0 , 66584E-75 5 5 
RLPAS=FLAP3-6. 

RLAPS'sRLPAS-S . 

RLPAA=AMAXt CRLPAS.O . 5 
RLAPP=AMAXi CRLAPS, 0 . 5 
RDFP-AMIN 1 CRLPAA, 1,05 

CLT=< <4 . 5S4+RMACH* C5 . 387*RMACH-2 . 225 + C 1 . 08 1 5*RDFP5 + < CWVEL/VTOT5 * 

1 , 033 1 5 >- , 0 035*CTETA+RLPAA* . 0 1 432 
C 

C*** LIFT 
C 


L=ROW*V2*SAREA*CLT 
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IF <RMACH- ,845)81 1 , 81 t , 812 
Btl IFCRMACH~.3)S13, 813, 814 

813 IF<RMmCH- .7)315, 815, 316 

815 COM= * 0 1 2 
GO TO 818 

812 COM=- , 10S9+* 1455*RMACH 
RK«- ,6411+. 8333*RMACH 
GO TO 319 

814 CDM~- , 0 1 ?35+ ,03?1*RMACH 
RK = - . 1 360 8+ . 2356+ftMACH 
GO TO 819 

816 CDM“.009?+ .0033*RMACH 
818 RK- . 0524 

019 CONTINUE 
C 

C++* DRAG 
C 

D=R0M*V2 + SAREA* < CDM+RK* < CLT *CLT} + . 0 1 0 5*GEAR+RLPAA* . 0 0 1 8+ * 833E-3 + 
1SPBRK) 

C 

O** SIDE FORCE 
C 

SFOR^RQUH 1 505 . * VTOT* C - . 9 1 7*VVEL- , 0 0 4*VT0T+CX I > 
DFIE=P+CSFIE*STTET/CTTET>+Q + <CFIE*STTET''CTTET>+R 
DTET=CF IE+GHSF IE+R 
DSY=tSFIE/CTTET;)*G+CFIE*R/'CTTET 
RF IE-RFIE+C C3 . #DF I E-DDFIE) *DT/'2 . > 

RTET=PT ET+<<3 . *DTET-DDTET) *DTV2 . > 

RSY=R3Y+C<3 . *DSY-DDSY) +DT/2 . ) 

DDFIE=DFIE 
DDTET -DTET 
DDSY=DSV 
C 

C**«* EULER ANGLES 
C 

PHI=RF lE*RAO 
THETA=RTET*RAD 
Xr-RSY^RAD 
STTET=S1N(RTET> 

CTTET*COSCRTET> 

SFI E=S IN CRF IE) 

cfie-coscrfie:- 

SSY*5IN<RSY> 

CSY = COS C RSY ) 



196 


c 

c*** ROLLING- PITCHING - AND YAWING MOMENTS 
C 

LLL=ROW*VTOT+CVTOT*SSPAN*<:-. 1 7 1 9^VVEL^VT0T+ ,00 1 1 3*CPH I ~ . 0 0 02 + CX I > 
l-< ,60745E7*P>> 

MMM=ROW+VTOT*<VTOT*SCORD*C ,046-C , 955*WVEL> I ‘VT0T>+ . 009*CTETA+ 
iRLAPP+<-. 0033>)-< . 128E8*Q)> 

NNN-ROUJ + VTOT+ < VTOT+SSPAN + ( , 1 1 5+VVEL/VTQT+ , 0 0 1 l*CXI)-< . 23978E7*R> > 
DP=< C <LLL^ , 332E7) >-R'+Q-*‘ C - S5G>+P*Q*< ,0974)^ 

DQ=< < < MMM.'' . 4S5E7 > > +F + R+ ( , <P*P)-<R*R} > * < .07675 ) 

DR“< < CNNN^ ,812E7))-P*Q*C , 127;-R*G>+< , 0453:0 
C 

C*** ANGULAR VELOCITIES IN BODY AXES 
C 

P=P+<<3 >*DP-DPP)*DT.>'2. ) 

Q=Q+c: C3 . *DQ-DQQ>*DT<'2 , ) 

R-R+C <3 . +DR-ORR ) *DT '2 . . ) 

DPP-DP 

DQQ=DQ 

DRR^DR 

C 

C*** AERODYNAMIC ANGLES 
C 

ALPHA=RAD*WVEL/'VT0T 

BETA=RAD*WEL/VTOT 

BETAG^BETA 

BET 1 « 1 . -<<VVEL+VVEL>'<2 . *VTOT*VTOT) > 

CON 1 =- 1/<69S7.*VT0T) 

UDOT=<CONi*CUVEL+BETl*D+<UVEL*VVEL/VTQT:>*SFGR-WVEL*L:> >- 
l<Q*WVEL-ft*VVEL>-32 . 2*STTET+T/6987 - 
VDQT- CC0N1*(VVEL*D-VT0T*8ET 1*3F0R) ) -<R**UVEL-P*tifVEL} +32 , 2+CTTET* 
1SFIE 

tdDOT = < CON 1 *<!j)VEL*BETT + D+ 'CUIVEL+V VEL/VTOT ) *SFOR+UVEL*L) ) - 
l<P*VVEL-G*UVEL;+32 . 2 + CTTET-tCFI E 
VTOT-SQRT <UVEL*UV£L+VVEL+ VVEL+WVEL*WVEL> 

V=VTOT f 1 ,69 
C 

C*** LINEAR VELOCITIES IN BODY AXES 
C 

UVEL=UVEL+< <3 , + UDQT~UDTT > + DT> 2 , ) 

VVEL^VVEL+C (3, *VD0T-VDTT>*DT/2 . > 

WVEL=WVEL + < <3 , +WD0T-WDTT)*DT-'2 , y 

UDTT=UDOT 

VDTT=»VDOT 

WDTT^WDQT 
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c 

o** LINEAR VELOCITIES IN VEHICLE AXES 
C 

rvx«cttet*csy*uvel+<sfie*sttet*csyh:fie*ssy>*vvel+<sfie*ssy+ 

ICE IE*CSY+STTET>+WVEL 

RVY-CTTET+SSY*UVEL+<CFIE*CSY+SFI E*STTET*SSY ) +VVEL+CCFIE+STTET+SSY 
1-SF IE+CSY J+UJVEL 

RV2 = -STTET*UVEL + SFIE*CTTET*VVEL+CFIE*CTTET + UJVEL 
VZ=-60 .*RVZ 
RAA= 1 3 , 0 7^'RAD 

VX= . 5735+RVY+ , 8 1 9 15*RVX+W I ND*COS< RAA) 

VV“ ,81915*RVY- * 5735*RVX+WIND*SIN<RAA) 

C 

C++* EARTH COORDINATE SYSTEM POINTS 
C 

XM=XM+CVX/6030 . 2>*DT 
Y-Y+VY+DT 
A=A+VZ*DT '60 . 

XI=AMOD(XI,360 , > 

PHI -AMOD < PH I > 360 . > 

THETA-AMODCTHETA, 360 . > 

A-AMAXUA, 0 . > 

TOTXX-TOTXX+DT 

TINT=3, 

IFCAMOD<TQT!<X,TINT> .GT,DT>GO TO 101 
IF< JK2-NUM1-1>897,797, 897 
79 7 IF<L0C1-JK4)S97,899j897 
897 CONTINUE 

LOC 1 =LOC 1+1 
899 CONTINUE 
C 

C*** CALCULATION OF DEVIATIONS IN STATES 
C 

DELU*UVEL-UU<LOCl 5+UJIND 
DEUJ=ttfV£L-UMlKLGCl > 

DELQ=Q-GCKLOCl > 

DELTcRTET-TEET (LOCI ) 

DELH«A-HHCLOC‘l > 

DELR«<DIST-RANGE<LQC1 >>*6080 * 

IF< JK1 -NUM 1 + 1 >398/761# 898 
761 IF < JK3-L0C2) 893 > 1 0 1 > 898 
893 JK3- JK3+ l 
101 CONTINUE 
RETURN 
END 
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SUBROUTINE RTOF 
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C 

C*«* SUBROUTINE TO CONVERT DATA REAL-TQ-FRACTI ON 
C 

GLOBAL TR IG, FP ICH 1 ,FPCH1 
IMPLICIT FRACTION <F> 

COMMON' PRMTR/V, XI - 6ETAC, DT 

CQMMON/'PRMTR'ALPHA , EETA, PHI , VX, VY, VZ, THETA, A, XM, Y, R, RIAS 
COMMON' FE AC.,' FV , FBNK > FP I CH , FA , FVZ , FHDG , FADF , FVQR , FCP l CH 
COMMON'FRAC'FER. FHER, DME<6 ) , ALT <7 ) 

COMMON'FD' ADF , VOR , EPS , HER, RAD 
FV=<200 ,-AMOD *! RIAS, 400 . >)'200 , 

FBNK1=PHI'3S0 . 

FBNK=FBNK1 +FBNK1 
FPICHi=-THET A'360 . 

FPICH=FPIC:H1+FPICH1 
IFtA.LT .0 . >A=0 . 

FA=<500 , — AMOD < A , 1000 . >:>'500 . 

FVZ=-FM INI ( 1 . , AMAX1 CVZ'4000 . ,-t . ^ 5 
FHDG1=AM0DC <X I ~BETAG> ,360 . >'3fcO . 

FHDG=FHD£1 +FHDG 1 
FADF1=-ADF'360 , 

FADF=FAOF 1+FAPF1 
FVOR1=-VOR'360 . 

FVOR=FVOR 1 +FVORI 
ERR=EPS*RAD-18 .07 
TEMPP=AMAX1 <ERR, -5 . 0 ) 

ERR“AMIN1 C5 . 0 , TEMPP) 

FER=ERR*0 . >2 

IF(XM . EO . ^ . > XM=0 .000 1 

AHER=HER ?RAD'<XM*60SO .2) 

TEMPP=AMAXt ( AHER, -0 . 7> 

TEMP=AMIN1<0 . 7, TEMPP > 

FHER=TEMF*0 . 22357 

RETURN 

END 



f 


! 


i 



199 


IMAGE DIALS 
C 

£>** SUBROUTINE TO DISPLAY THE INSTRUMENT PANEL 
C 

INTEGER iFTIMX 
IMPLICIT FRACTIONCF) 

COMMON /FRAC/TV, FBNK, FP I CH , FA , FV2 , FHDG > FADE /FVOR , FCPICH 
COMMON/FRAC/FER, FHER,DMEC6> , ALTC7> 

LINKAGE PTR<S:»,LYNEC4> , PNTRC20 > 

LINKAGE GSI (8) , LOCKS) , ADEN (IS) , VORNC 10 ) i HDNCC5) 

C 

(>*♦ ADD FT I MX TO IT I ME * TO UPDATE THE DATA-UPDATE CLOCK 
C 

♦ ITIME=MTIME+$FTIMX 

POSCHARCO , 2417F, -0 . 0 1434F.-0 , 3F> "aSSS" > 

POSCHAR < DME) 

POSCHARC ALT) 

LDYCO.F) 

TABLE2DCHDNG) 

LDXC-0 . ?5F ) 

LDYCG.4 3F> 

LSCLCO . 275F ) 

LR2CFV) 

TABLE2DCPNTR) 

LDX ( 0 , 7 IF ) 

LDYCO , 52F ) 

LSCL< 0 . 2SF) 

LR2CFA) 

TABLE2DCPNTR) 

LDX ( 0 * 71S26F) 

LDYC-Q . 2G575F ) 

LSCLCO, 285F) 

LRZCFVZ-G r 5F) 

TABLE2DCPNTR) 

LDXCO .F> 

LDYC-0 . 323F) 

LSCLCO ,33F> 

LR2CFHDG) 

TABLE2DC1CCARD) 

ROTZC-O . L00338F) 

A 2DT BUG 

ROTZC-O . 19444F) 

DXCFER) 

TABLE2DCLYNE j 
LRZCFHDG; 

LDXC-0 . 745F) 

LDY < -0 * 212F ) 

LSCLCO , 275F ) 

ROTZCFAD F> 

TABLE2DCADFN) 

ROTZCFVDR-FADF) 

TABLE2DCV0RN) 

LR2CFHDG) 

TABL£2DC*CCARD> 

LDX CO r F > 
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LDfKO 66F) 

LSCKO . 32F > 

LRZ< FBNK > 

TABLE2D<PTR> 

LSCL< l .OF) 

ROT X<FP I CH> 

LAI < 16B, 1 .OF) 

LAK17B.0 ,5F> 

TABLE'3D< $HRZON ) 

RETURN 

DATA2DCLYNE) 

Z3ETC0 .OF) 

LINE<Q .F, C , 43F, 0 ,F,~0 .5286F) 

ENDLIST 

ENDDATA 

DATA2D<PNTR) 

ZSET < 0 . OF) 

NOVEvO . 0 F i —0 ♦ 5F > 
DRAbK-0,02F,-0.56F) 

DRAUK-0 .02F,-0 ,74F> 

DRAtlKO . 0 F * — 0 .3 F> 

DRAUKO ,02F, -0 .74F) 

DRAbKG . 02F, -G ► 56F) 

ORAUKO .OF, -0 . 5 F) 

DR AUK 0 . 0 F , — 0 ,26F> 

DRAUKO .04F,-0 .2F> 

DRAUKO . 0 4F 0 .OF) 

DRAUKO .06F,0 . IF; 

DR A UK -0 .06F,0 , 1F> 

DRAUK-0 .04F/0 .OF) 

DRAUK-0 . 0 4F> -0 .2F) 

DRAUKO ,OF,-0 .2SF) 

WOVE< 0 . 0 F, 0 .OF) 

DRAUKO . OF , 0 . OF) 

ENDLIST 
ENDDATA 
DATA2DCG3I ) 

2SET < G .OF) 

NOVEC-G ,3F.O .55 F) 

DRAUK-0 .36F,0 ,59F) 

DRAUK-0 .3F-0 .63F> 

WOVEOO ,3F,-0 .30D 
DRAUK-0 . 36F t -0 .34FX 
DRAW<-0.3F,-0 . 38F ) 

ENDLIST 
ENDDATA 
DATA2DCL0CI ) 

ZSETXO .OF) 

MOVE<-0 . 04F, 0 . X6F) 

DRAW(Q .OF.O . 12F) 

DRAUKO « 04F j 0 . 16F ) 

ENDLIST 

ENDDATA 

DATA2CKADFN) 

29ETC0.0F) 
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WOVE < -0 . 1F,Q . 5F ) 
DRAWOO . 1F.-0 .7F> 
DR AW < 0 .OF,-G .SF> 
DRA'lKO . IF, -0 ,?F> 
DRAWCO . 1 F , 0 .5F> 
DRAWOO . 14F, 0 . 5F ) 
DRAUI < 0 , OF j 0 . QF > 
DRAWCG . 1 4F , 0 ,5F> 
DRAW <0 * 1 F , 0 . 5F> 
WOVE < 0 . OF # 0 . 9F > 
DftAUKO . OF, 0 . SF> 
HOVE < 0 , OF, 0 , OF) 
DRAW < 0 .OF .0 -OF) 
HOVECO ,0F,-0 ,5F> 

0 R A t' 1 < 0 .OF, -0 . 9F> 
ENDLIST 
ENDDATA 
DATA2DC VORN> 

ZSET < 0 .OF) 

WOVECO . OF, 0 . 3F> 
DRAUK-0 . 04F > 0 ,6F> 
DRAtJLK-0 .04F, -0 . 8F) 
DRAttKQ - 0 4F * “0 .8F> 
DRAUKO .Q4F..0 . 6F> 
DRAW C 0 ,0F,0 ,£F) 
HOVECO i 0 F j 0 . 9F) 
DRAW CO . OF v “0 . SF> 
ENDLIST 
ENDDATA 
A ADEPT 

BUG : 0 


1631224426; 1631221261 ; 1314423345; 1631224427 
20000267431 1146211662; 11 462 1 546 1 ; 0 63 1 4 l 443 1 
0767613244; 1 1462 1 546 1 J 6631462316:6314655465 
6000013054:6000013055; 6000013055:7000005462 
7000005463 J 7000005463J 1000072314; 1000072315 


1000072315:2000064022; 2000064023; 1777764023 
FORTRAN 

DATA2D < PTR ) 

ZSET CO . F) 


MOVECO , F , 0 ,83337) 
DRAWC-0 * 1SF, 0 , 6667F ) 
DRAW C 0 . 1 5F , 0 . 6667F) 

DR AW C 0 , 0 F , 0 . 33 3 3 F > 

ENDLIST 

ENDDATA 

DATA2DCHDNG) 

ZSET CO -OF) 

MOVE < -0 .0 15F, 0 . 0 3 6 2 5 F *> 
DRAUKO , F , 0 . 0025F) 

DRAW ( 0 . 0 1 5F , 0 .03625F) 

ENDLIST 

ENDDATA 

RETURN 

END 


ORIGINAL PA&5TE3 
OF POOR QUAUTSfl 



! 
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